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Abstract 


This report presents research results on general serial robotic ma- 
nipulators modeled with structural compliances. Two compliant manipulator 
modeling approaches, distributed and lumped parameter models, are used in 
this study. System dynamic equations for both compliant models are derived 
by using the first and second order influence coefficients. Also, the proper- 
ties of compliant manipulator system dynamics are investigated. One of the 
properties, which is defined as inaccessibility of vibratory modes, is shown 
to display a distinct character associated with compliant manipulators. This 
property indicates the impact of robot geometry on the control of structural 
oscillations. Example studies are provided to illustrate the physical interpre- 
tation of inaccessibility of vibratory modes. 

Two types of controllers are designed to control compliant manipu- 
lators. These controllers are designed for compliant manipulators modeled by 
either lumped or distributed parameter techniques. In order to maintain the 
generality of the results, neither linearization is introduced, nor any nonlinear 
term is neglected to simplify the controller design problem. The first type con- 
troller is built for N-degree-of-freedom robots with known system parameters, 
and several distinct control algorithms are introduced. Example simulations 
are given to demonstrate the controller performance. The second type con- 
troller is also built for general serial robot arms and is adaptive in nature 
which can estimate uncertain payload parameters on-line and simultaneously 
maintain trajectory tracking properties. The relation between manipulator 

iii 


motion tracking capability and convergence of parameter estimation proper- 
ties is discussed through example case studies. The effect of control lupin 
update delays on adaptive controller performance is also studied. 
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Chapter 1 


Introduction 


The goal of building efficient robots draws growing attention to the 
study of lightweight robotic manipulators. In order to maintain operational 
precision, traditional industrial robots are built relatively rigid at the cost of 
heavy weight and slow operational speed. In addition, the payload capacity 
is generally limited to as small as 1% of the manipulator weight to avoid 
deflections caused by inertial loading. Apparently, such robots consume large 
driving power and are inefficient to operate. As a remedy, the next genera- 
tion robots tend to be lighter, faster, and have larger payload-to- weight ratios. 
However, a lightweight structure is subject to deformation and oscillations un- 
der high-speed inertial load. Therefore, building a high precision lightweight 
robot demands a thorough study of the inherent compliance problems from 
mechanism design to control issues. So far, lightweight manipulators are used 
mainly in outer-space exploration where inertial load and precision are not of 
concern; yet, development for high precision industrial applications is still at 
the infancy stage. This report will present research results on the dynamic 
modeling and controller design of serial robotic manipulators modeled with 
structural compliances. In this report, we will refer to this type of robotic 
arms as compliant manipulators. 

This work covers several major topics. Literature survey on the 
study of compliant manipulators will be presented in this chapter. The 
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methodologies and algorithms used by researchers will be summarized. The 
second chapter will introduce some basic and handy tools for dynamic model- 
ing of robotic manipulators. The third chapter will derive compliant manipu- 
lator dynamics by both distributed and lumped parameter models. Based on 
the derived system dynamics, the inherent dynamic properties will be inves- 
tigated in the fourth chapter. The fifth chapter will design different control 
laws for compliant manipulators with known system parameters. In the sixth 
chapter, an adaptive algorithm will be introduced, which is capable of on-line 
motion control and payload estimation. In order to build the adaptive con- 
troller, system dynamics of uncertain parameters and an estimation method 
are also presented in the sixth chapter. The final chapter will summarize 
the effort of this work. Portions of this work have been reported in [Lin. 
Tosunoglu, and Tesar. 1990, a], [Lin, Tosunoglu, and Tesar, 1990, b], [To- 
sunoglu, Lin, and Tesar, 1990, a], [Tosunoglu, Lin, and Tesar, 1990, b], [Lin. 
Tosunoglu, and Tesar, 1989], and [Tosunoglu, Lin, and Tesar, 1989], which. 

due to their distinct approach, are not included in the following literature 
survey. 

1.1 Dynamic Modeling Survey: Distributed Parame- 
ter Model 

The structural flexibility modeling of a compliant manipulator con- 
centrates on two elementary components: links and joints. Lack of structural 
rigidity in link design causes link compliance. On the other hand, flexibility 
of power transmission is usually the major contributor of joint compliance. 
Various models are proposed by researchers to describe link and joint com- 
pliances. Nevertheless, they could be categorized into two main disciplines: 
distributed and lumped parameter models. Both models have been applied 
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to model link compliance. However, joint compliance is always modeled by a 
lumped parameter model. In distributed parameter models, a link is modeled 
as a continuous beam which has infinite degree-of-freedom (DOF) oscillations. 
Generally, finite assumed modes are chosen to discretize the oscillations. The 
chosen mode shapes are mainly admissible functions satisfying given geomet- 
ric boundary conditions. The assumed mode method not only reduces system 
dimension, but also separates the spatial and time variables of each vibratory 
mode, consequently, the system dynamics could be expressed els a function 
of generalized coordinates composed of nominal joint parameters and vibra- 
tory amplitudes. Some of the activities in distributed parameter model are 
reported in this section. [Hughes, 1979] models each compliant link as a 
continuous system and derives general compliant manipulator dynamics by 
the Newton- Euler approach. He computes the inertial dynamic force at each 
compliant link first, and then finds the compliant dynamics from flexibility 
kernel. In this work, the velocity coupling terms are neglected under slow mo- 
tion assumption. [Sunada and Dubowsky, 1981] use a finite element model 
and the NASTRAN software package to study compliant mechanism motion. 
[Book, 1984] uses the Bernoulli-Euler Theory to model a compliant link under 
lateral bendings and longitudinal elongation. The rotatory inertial effect is 
neglected in the system dynamics. In this work, the author uses the same 
modal amplitude in all directional modal functions. The 4x4 homogeneous 
transformation matrix is applied to perform kinematic analysis. [Low, 1987] 
also uses Bernoulli-Euler Theory to build compliant system dynamics. In 
his recent work, [Low, 1989] presents solution schemes for inverse dynam- 
ics and kinematics. The author also discusses the assumed mode solution 
under different boundary conditions. [Naganathan and Soni, 1987] analyze 
lateral bendings and longitudinal elongation of a compliant link by the finite 
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element approach. Following the Timoshenko Beam Theory, the rotatory in- 
ertia and shear effects are included. The system dynamics are derived bv 
Galerkin s method. [Kane, Ryan, and Banerjee, 1987] model a spatial ma- 
nipulator with a compliant last link. Instead of using the Bernoulh-Euler 
Theory, the shear and centrifugal stiffening effects are included in the study. 
However, by applying the small deflection assumption, all vibratory coupling 
terms are neglected by the authors. In the above examples, multi-directional 
oscillations of the compliant link are considered. Interestingly, a great por- 
tion of modeling and control works of compliant manipulators focus on planar 
one- or two-link arms, and in these works only unilateral bending is investi- 
gated. For example, [Rakhsha, and Goldenberg, 1985] model a one-link arm 
in transverse bending. The compliant link is treated as a cantilever beam, 
and Newton-Euler approach is applied to derive system dynamics. [Usoro, 
Nadira, and Mahil, 1986] use the finite element approach to model a planar 
arm lateral bending. The Hermitian polynomials are chosen as mode shapes. 
The results are applied on a two-link planar arm example. [Nicosia, Tomei. 
an d Tornambe, 1986] employ monomial mode shapes up to fourth orders to 
model a planar arm with lateral bending. [Benati and Morro, 1988] model a 
planar link as clamped-free beam with end-point mass whose lateral bending 
is depicted by two eigenmodes. Since two modes are suggested, the end-point 
deflection and tangent angle are used as the generalized coordinates. The 
model is simulated on a two-link planar arm with a compliant link followed 
by a rigid link. Instead of a one-link arm, [Yuh, Young, and Baek, 1989] 
model a cylindric planar arm composed of one pivot joint and one slider. The 
sliding link is compliant whose unilateral bending is modeled as a cantilever 
beam. Due to the sliding motion, the compliant link length changes continu- 
ously, therefore, the mode shapes are normalized for a unit link length, and 



only the first two primary modes are modeled. To verify their analytic model, 
laboratory experiments are conducted by the authors, in which an accelerom- 
eter is added to the tip of the arm, whose double integration provide the tip 
displacement. The experimental results show good agreement with the ana- 
lytic model. [Wang and Vidyasagar, 1988] study the dynamic model of a five 
DOF mechanism which is composed of a 4-bar linkage with a rotating base. 
The output link is flexible and bends in the direction perpendicular to the 
plane of the 4-bar. The link compliance is defined following the Bernoulli- 
Euler Theory. [Yang and Donath, 1988] model one-link arm dynamics by 
considering both joint and link compliances. The link deflection is described 
by the Bernoulli-Euler Theory; the modal eigenvalues and eigenfunctions are 
derived based on the given geometric and natural boundary conditions. The 
authors suggest that the first two modes give fair representation of link de- 
flection. Their simulation results show that the first mode amplitude is about 
ten times the second mode magnitude. Since both clamped-free and pinned- 
free boundary conditions have been used in link compliance study, [Bellezza, 
Lanari, and Ulivi, 1990] derive the exact solutions of one-link arm vibratory 
dynamics by using both boundary descriptions. After comparing the solu- 
tions, the authors conclude that both results are equivalent after coordinate 
transformation. Another research topic in distributed parameter model is 
how many assumed modes should be used so that system dynamics have an 
acceptable level of accuracy and manageable size. Some works in this dis- 
cipline are presented here. [Hastings, Dorsey, and Book, 1989] use balanced 
realization to identify the model order required for a compliant system. They 
linearize general compliant system dynamics, and by the assumption that 
the linearized system is controllable and observable, the number of dominant 
modes are identified from the solution of the linearized dynamic equations 
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by the singular values decomposition technique. [Tsujisawa and Book, 19S9] 
apply the reduced order method to decide the dominant modes of a specific 
robot called RALF (Robotic Arm, Large and Flexible) which is a two DOF 
parallel mechanism with two ten-foot long links. The report suggests that 
two modes for each link is optimal from the control point of view. In their 
experimental study, it is observed that the spectrum ratio of the first mode to 
the second mode is ten to one. Also, [Krishnan and Vidyasagar, 1988] derive 
a reduced order model for a single-link arm by Hankel norm minimization. 
Finally, for on-line motion control, the vibratory states need to be identified. 
Regarding this subject, [Hastings and Book, 1986] use strain-gauge measure- 
ments and a reduced order observer to reconstruct the modal amplitudes and 
velocities, and [Hastings and Ravishankar, 1989] suggest several link deflec- 
tion measurement methods and discuss the effect of the measurement tech- 
nique on model order estimation. According to the works surveyed in this 
report, various deflection measurement equipments have been used, which 
include strain gauges, accelerometers, laser-interferometers, photodetectors, 
piezoelectric detectors, and vision systems. 

1.2 Dynamic Modeling Survey: Lumped Parameter 

Model 

Ideally link oscillations are composed of infinite modes, yet, the first 
fundamental mode generally dominates most of the elastic energy as reported 
by [Tsujisawa and Book, 1989] and [Yang and Donath, 1988]. Additionally, 
relatively high energy is required to bend a robotic link into high order mode 
shapes. Also, structural damping makes higher modes difficult to detect; 
therefore, a lumped parameter model is often used on compliant links to 
create an efficient dynamic description suitable for real-time motion control. 


Besides modeling links, a lumped parameter model is frequently used to define 
joint compliance. In a lumped parameter model, each structural compliance 
is replaced by an equivalent spring. The two types of springs mostly used are 
translational and torsional springs. The former causes linear deflection and 
the later creates torsional deformation. The stiffness of the modeled spring 
is evaluated by either elemental stress-strain relations or by experimental 
identification. Some representative works are listed below. 

[Tesar, 1978] uses lumped parameters to model an N DOF pla- 
nar arm with compliant links. The loads at the distal end of each link are 
analyzed first, then the subjected deformations are derived from a static can- 
tilever beam deflection relation. [Fresonke, Hernandez, and Tesar, 1988] fur- 
ther extend this approach to cover the deformations of a spatial mechanism 
with seven possible deflections at each link, i.e., one joint deformation and 
six distal end deflections and twistings. Since static load and deformation 
relations are used, this approach is termed quasi-static deflection analysis. 
Since quasi-static deflection is considered to be the major structural distur- 
bance to end-point precession, it should be compensated for during motion 
control. Therefore, [Hernandez, 1989] develops real-time computation soft- 
ware to evaluate the end-effector deflection under inertial and external loads. 
In the lumped parameter model, the structural stiffnesses could be evalu- 
ated from elemental stress-strain relation. However, for an assembled robot, 
the elemental stiffness matrices are difficult to obtain analytically. There- 
fore, metrology approaches are applied to obtain the modeled spring stiffness 
values. [Behi, 1985] experimentally identifies the lumped parameters of a T3- 
776 robotic manipulator. Modal analysis is employed to identify the natural 
frequencies and modal amplitudes of the excited manipulator. The experi- 
mental data are fed into the lumped model to obtain system parameter values. 
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Instead of using frequency domain analysis, [Sklar, 1988] applies end-point 
loads on a static T3-776. A force sensor attached to the wrist reads the force 
and torque components along each orthogonal direction. The resultant hand 
deflections are measured by twin theodolite systems. From both force and 
deflection data, the global compliance matrix could be obtained, which in 
turn produces the modeled stiffness values after inverse kinematic operation. 
In order to obtain averaged stiffness values, the tests are repeated at dif- 
ferent robot configurations and external loads. Similar metrology activities 
are reported by [Good, Sweet, and Strobel, 1984] and [Elmaraghy and Johns, 
1988]. The lumped parameter model is also applied to the study of the Spatial 
Shuttle Remote Manipulator System (RMS). [Book, 1979] models the RMS 
as a massless chain connecting two end-point masses, i.e., the Orbiter and 
payload. The global hand compliance matrix is derived by using 4x4 ho- 
mogeneous transformation matrices. Similarly, [Sellhorst, 1982] describes the 
compliances of the RMS as three linear torsional springs and studies payload 
motion response subjected to the thrust fired on Orbiter. More studies on 
lumped parameter model could be found. For example, [Huston, 1980] mod- 
els multibody dynamics by assuming that each pair of bodies is connected 
by three translational and three torsional springs. The system dynamics are 
derived by Kane s partial velocity and partial angular velocity approaches 
along with the principle of virtual work. The result is applied in [Kelly and 
Huston, 1981] to derive manipulator dynamics for a six-link arm. In this 
work, the stiffness values are derived from elemental stiffness relations. The 
elemental stiffness matrix is also used by [Shahinpoor and Meghdari, 1988] 
to derive the global hand stiffness matrix. Instead of using one set of lumped 
parameters for each compliant link, [Huang and Lee, 1988] suggest to divide 
a compliant link into several lumped parameter segments to obtain a more 
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accurate model. 

1.3 Survey on Compliant Manipulator Control 

Besides dynamic modeling, a great portion of research on compli- 
ant manipulators is carried out on motion control. However, unlike modeling 
techniques, various controllers have been designed and tested numerically 
or experimentally. According to the control algorithm used, the following 
surveyed reports are classified into optimal control, singular perturbation 
method, external feedback linearization, inverse dynamics, quasi-static deflec- 
tion compensation, resonance avoidance control, linearized system dynamics 
control, and adaptive control techniques. 

1.3.1 Optimal Control 

One special character of one-link flexible aims is that system dy- 
namics contain no coupling terms. Therefore, after modal decomposition, 
the system dynamics are reduced to a linear time-invariant system. Fiom 
that process, many researchers have discovered an interesting property that 
for one-link arms the transfer function between tip output and actuator input 
has non-minimum phase zeros. This means that for a given tip trajectory, the 
inverse dynamics could not be defined directly because the inverse transfer 
function is unstable. Hence, optimal control is used by some researchers to 
control the tip motion of one-link arms. One of the most famous studies in 
this area is reported by [Cannon and Schmitz, 1984] who model a one-link arm 
as a pinned-free beam. The Bernoulli-Euler Theory is used to derive system 
flexibility dynamics. Then the dynamic equations are decoupled by orthogo- 
nal modes. The decoupled system parameters are identified experimentally. 
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Finally, the tip motion is controlled by an optimal algorithm. Similar works 
on one-link arm are reported by [Sakawa, Matsuno, and Fukushima, 1985 ], 
[C’hassiakos and Dekey, 1986], [Lee and Castelazo, 1987], [Pal, Stephanou, 
and Cook, 1988], and [Biswas and Klafter, 1988], Optimal control is also ap- 
plied on a multi-DOF planar mechanism containing a compliant beam as the 
last link, such as reported by [Matsuno, Fukushima, Iviyohara, and Sakawa, 
1987] and [Schmitz, 1989]. However, in both works, flexibility dynamics are 
linearized around terminal static states. 

1.3.2 Singular Perturbation Method 

Compliant manipulator dynamics are composed of two parts: one 
basically describes the dynamic balance of driving joints, called the rigid part 
dynamics, and the other depicts the dynamic interactions due to structural 
flexibility, or the vibratory part dynamics. Each part contains terms of nom- 
inal and vibratory parameters. In the singular perturbation method, it is 
assumed that the solutions of the vibratory part dynamics, a set of second 
order differential equations, are stable and called integral manifolds. Because 
of the nonlinear couplings and kinematic dependence, it is difficult to solve 
integral manifolds explicitly. But it is possible to find their approximations 
by expanding the vibratory dynamics around the rigid body mode by using 
the Taylor series method. If the structural compliances are small, this ap- 
proximation will produce the major part of the integral manifolds in terms of 
rigid body parameters. A back substitution of these vibratory mode solutions 
into rigid part dynamics converts all vibratory parameters into rigid body dy- 
namic parameters. At this point, any control algorithm developed for rigid 
manipulators could be applied on the rigid part dynamics. In this process, the 
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integral manifolds arc assumed stable, therefore, they are not considered in 
the rigid part control design. However, the vibratory modes do not necessar- 
ily slide on the integral manifolds, hence, a small perturbed control input is 
applied to force the vibratory modes to track the integral manifolds. In doing 
so, it is assumed that the perturbed inputs are so small that it will not affect 
the rigid part’s dynamic response. The drawback of singular perturbation 
is that in approximating the integral manifolds high order dynamic parame- 
ters are required, for example, fourth order dynamic parameters are used to 
produce the first order approximation. For a multi-DOF manipulator, it is 
highly demanding to derive such high order dynamic parameters. Therefore, 
this method is used mainly on simple systems such as one-link arms modeled 
with link or joint compliance. Some examples of this specific subject can 
be found in [Khorasani and Spong, 1985], [Marino and Spong, 1986] [Spong, 
Khorasani, and Kokotovic, 1987], and [Slotine and Hong, 1986] for one-link 
arm with a compliant joint; also [De Maria and Siciliano, 1987], [Siciliano and 
Book, 1988], and [Khorrami and Ozguncr, 1988] for one-link arms with link 
compliance. In the last three reports, the authors model link compliances by 
using the Bernoulli-Euler Theory with clamped-free boundary conditions. 

1.3.3 External Feedback Linearization 

According to [Su, 1982], a nonlinear system coiild be converted into 
an equivalent linear system provided that system dynamics satisfy certain 
given conditions. The transformation process is called diffeomorphic coordi- 
nate transformation, and nonlinear system rank and involutivity conditions 
need to be checked over a special set of vectors derived by Lie brackets to 
ensure existence of a nonlinear transfer function. Provided that the transfer- 
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mution exits, then the manipulator dynamics could he expressed in term of a 
linear, time-invariant, controllable system whose controller is easy to design. 
Once a control law is developed for the equivalent linear system, the non- 
linear system controller is obtained by an inverse transformation. Although, 
the conditions could be checked by tedious but straightforward differentiation, 
there is no simple rule guiding the selection of nonlinear transformation func- 
tion, or diffeomorphisln. The nonlinear compensation, or computed torque 
method, of rigid manipulator control is a special application of this technique. 
However, for compliant manipulators, this approach is still at a conceptual 
stage and is used only on one-link arms with link or joint compliance, such as 
reported by [Spong, 1987] on a one-link arm with compliant joint, [Nicosia, 
Tomei, and Tornambe, 1989] on one-line arm with flexible link, and [De Luca, 
Isidori, and Nicolo, 19S5] on conceptual design. 

1.3.4 Inverse Dynamics 

Inverse dynamics basically is an open loop control scheme. For a 
given hand trajectory, the required driving torques are computed along the 
trajectory to ensure precise tracking. For rigid manipulators, inverse dynam- 
ics is mainly solving the inverse kinematics problem and is accomplished in 
one iteration. However, for compliant manipulators, structural compliance 
causes disturbances to hand motion, and due to the nonlinear interaction 
between nominal and vibratory modes, more than one iteration is generally 
required to find the final driving torques. For example, in the first iteration, 
rigid manipulator assumption is used to find approximated driving torques. 
The torques are applied on the compliant manipulator to solve the associated 
structural deformation. Then the resultant hand deflections are compensated 
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by adjusting nominal joint motion to maintain tracking precision. The driving 
torques of compliant manipulators are evaluated from compensation results. 
The process is repeated until an acceptable level of precision is reached. This 
technique is applied by [Asada, Ma, and Tokumaru, 1987] on a two-link pla- 
nar arm. A similar approach is found in [Dado and Soni, 1986] for multi-link 
arms modeled by the finite element method. Instead of time domain ap- 
proach, [Bayo and Moulin, 1989] find the transfer function between the tip 
and actuator input of a one-link flexible arm in the Laplace domain. Once the 
transfer function is defined, the actuator input is computed by convolution 
integral for a given tip trace. [De Luca, Lucibello, and Ulivi, 1989] use inverse 
dynamics to track various output points other than the end-effector tip. In 
their algorithm, the number of output states must equal to that of nominal 
joints. The tracking stability is also analyzed in this report. 

1.3.5 Quasi-Static Deflection Compensation 

Quasi-static deflection is considered to be the major contributor of 
structural deformation. Some reports suggest compensation of quasi-static 
deflection by either off-line trajectory planning or control-in-the- small algo- 
rithms. [Gupta, 1987] studies stationary compliant manipulator deflections 
under external forces. The hand deflections are compensated by adjusting the 
robot configuration. [Pfeiffer, 1989] divides the problem of compliant robot 
control into three stages. The first stage plans off-line optimal trajectory for 
rigid manipulators and computes the associated driving torques. The second 
stage finds the associated structural quasi-static deflection and adjusts joint 
variables to compensate the deflection. The last stage linearizes system dy- 
namics around the terminal point of task trace and builds an on-line controller 
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for the linearized time-invariant system. This control algorithm is tested on a 
two-link planar arm modeled with link and joint compliances. In control-in- 
the- small technique, a mechanism performing fine-tuned motion is added to 
compliant manipulator design to compensate structural deflection. [Zalucky 
and Hardt, 1984] design a link composed of two parallel beams. The distal 
ends of the beams aie jointed by a hydraulic servo. The rigiditv of the link 
could be increased by regulating the hydraulic servo. [Oliver, Wysocki, and 
Thompson, 1985] replace one grounded pivot joint of a four-bar mechanism 
by a fast moving slider to actively compensate the output link deflection. 
[Tlusty and Wegerif, 1986] use a cam mechanism to compensate the deflec- 
tion of a T3-776 robot during cutting process. The robot is modeled by a 
lumped parameter model. The global hand stiffness matrix is derived first, 
then hand deflections are computed form the stiffness matrix together with 
cutting forces measured at the wrist. The added cam then compensates the 
calculated deflection by providing the cutter with a fast but small sliding mo- 
tion. In these reports, the fine-tuned mechanisms are limited to one degree 
of freedom, A micromanipulator capable of six-DOF fine-tuned motion is 
designed and analyzed by [Hudgin and Tesar, 1988] and [Han, Travel*, and 
Tcsar, 1989]. 

1.3.6 Resonance Avoidance Control 

A group of activities on compliant manipulators are devoted to struc- 
tural resonance study. [Cleghorn, Tabarrok, and Fenton, 1984] analyze the 
influence of running speed on the stability of a compliant four-bar mecha- 
nism. They solve the eigenvalues of system dynamics and find the associated 
running speeds. Through eigenvalue locations, the stable and unstable op- 
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eration speeds could be identified. In order to study the induced geometric 
stiffness effects on system stability, [Anderson, 1985] linearizes system dy- 
namics around an equilibrium point and studies the effect of external forces 
on system stability. The manipulator used in this study is a three-link planar 
arm modeled with resilient joints. [Rivin, Zeid, and Rastgu-Ghamsari, 1985] 
model the compliances of a two-prismatic-joint planar arm by the lumped 
parameter approach. Two translational and one torsional springs are added 
to each joint of the arm. By neglecting vibratory velocity terms, the sta- 
ble eigenvalues of the system dynamic equations are analyzed to examine 
the effect of nominal joint velocity on system stability. [Streit, Krousgrill, 
and Bajaj, 198C] linearize compliant manipulator dynamics and analyze sys- 
tem stability under repetitive operation from the eigenvalues of the linearized 
system. They apply this technique to a two-link planar arm modeled with 
lumped parameters. [Chiou and Shahinpoor, 1990] study the force control 
effect on system stability. They model two-link planar arm flexibility by the 
Bernoulli-Euler Theory. Hybrid force/position control is also adopted to form 
a closed loop control action. By slow motion assumption, the nonlinear terms 
are neglected, then the closed-loop system dynamics are linearized around an 
equilibrium position. To investigate system stability, the eigenvalues of the 
final linear dynamic equations are analyzed over various force feedback gains, 
force sensor stiffness, and structural flexibility. Other than stability study, 
[Singer and Seering, 1989] suggest using a counteractive oscillation to can- 
cel existing structural vibration. They also suggest that for bang-bang type 
control the rectangular input commands could be preshaped to remove sen- 
sitive frequency contents. However, the authors limit their study to a simple 
mass-spring-damper model. 


1G 


1.3.7 Linearized System Dynamics Control 

Due to the nonlinear coupling between nominal and vibratory modes, 
building a controller for compliant manipulators is a difficult and challenging 
task. However, it is suggested that compliant manipulator control problem 
could be simplified by linearizing compliant system dynamics. [Chalhoub and 
Ulsoy, 1987] develop a controller for a spherical coordinate robot with two rev- 
olute joints and one prismatic joint. The prismatic joint is flexible and both 
principal lateral bendings are depicted by the first modes. The controller is 
built on linearized system dynamics, and pole placement technique is applied 
to locate the feedback gains. This algorithm is experimentally tested on a 
one-link planar arm. One special feature of this work is that observation and 
control spillover effects are examined. [Oosting and Dickerson, 1988] study 
the motion response of a two-link planar arm. Lumped parameters arc em- 
ployed to model both link and joint compliances. The system dynamics are 
linearized about the desired motion, and a control law for the linear system 
is designed with feedback and feedforward components. [Henrichfreise, 1988] 
studies the control of a manipulator modeled with three resilient joints and 
two compliant links. The system dynamics are linearized around an operating 
point. The controller feedforward and feedback gains of the linear system are 
selected from a special criterion reported in this work. (Nathan and Singh, 
1989] divide the control of robotic arm with compliant links into two phases. 
In the first phase, system vibratory motion is neglected, and nominal joints 
are controlled by variable structure control law. The second phase starts 
when robot reaches the vicinity of terminal point. The system dynamics are 
then linearized around the terminal point. A vibration stabilizing controller 
is designed for the linear time-invariant system by pole placement technique. 
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At this stage both nominal and vibratory controllers are executed, and it is 
assumed that the vibratory controller is relatively small and does not affect 
nominal motion control. 

1.3.8 Adaptive Control 

The adaptive control techniques applied on compliant manipulators 
include self-tuning regulator, model reference, and gain scheduling methods. 
In self-tuning approach, [Yang and Gibson, 1989] adaptively control a two- 
link planar arm with a flexible beam as the second link. The authors assume 
that system dynamics could be described by an autoregressive moving-average 
(ARMA) model. Then, the coefficients of the ARMA model are estimated 
on-line. The control algorithm of the ARMA model is one-step ahead opti- 
mization. Similarly, [Yurkovich, Tzes, Lee, and Hillsley, 1990] define a two- 
link planar arm modeled with link compliances by an ARMA model, and 
both pole placement and one-step ahead optimization are employed to design 
control inputs. [Yuli and Tissue, 1990] control a two-link planar arm with 
joint compliances but rigid links. The continuous system dynamics are lin- 
earized around a given trajectory and then converted into discrete time form 
by Euler’s method. The system parameters are assumed unknown and esti- 
mated on-line. The control inputs are defined by pole placement technique. 
[Cetinkunt and Wu, 1990] use a Lattice filter to estimate the coefficients of an 
autoregressive model which represents system dynamics of a one-link flexible 
arm. Two controllers are proposed: fixed-pole PD controller and one-step 
ahead optimization. Similar self-tuning control could be found in [Koivo and 
Lee, 1989] and [Chen and Menq, 1990]. A common assumption used in self- 
tuning regulator design is that the estimated system parameters vary slowly 
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in comparison with state variables. Also, since in the ARM A model nonlinear 
dynamic parameters are replaced by simple lumped coefficients, information 
such as payload mass, center of mass location, and moment of inertia are dif- 
ficult to extract from on-line estimate data. Regarding other adaptive control 
applications, [Yuan, Book, and Siciliano, 1989] use model reference method 
to control a one-link flexible arm to behave like a decoupled, stable, linear, 
time-invariant system. In gain scheduling control, [Nelson and Mitra, 19SC] 
compute off-line the optimal feedback gains of a single-link arm at different 
payload magnitudes. During on-line control, the uncertain payload is esti- 
mated by the gradient method, then the optimal feedback gains are adjusted 
accordingly with the estimated payload value. In this work, link compliance 
is modeled by the lumped parameter method. Similar work could be found 
in [Menq and Chen, 1988] and [Yurkovich, Pacheco, and Tzes, 1989], Both 
works focus on control of single-link arms modeled as distributed systems. 
However, the former uses a gradient method to perform on-line payload esti- 
mation, while the latter identifies the payload by an accelerometer attached 
at the tip of the link. A detailed survey of adaptive control of rigid robotic 
manipulator is reported by [Tosunoglu and Tesar, 1988]. 

1.4 Other Approaches 

Besides the efforts reported above in modeling and control areas, 
progress is also reported on strengthening a lightweight manipulator by struc- 
tural design. For example, [Rivin, et al., 1987] use combinational links to 
increase structural rigidity and reduce inertial weight. In their design, a link 
is composed of two segments made of steel and aluminum separately. As sug- 
gested by the authors, the optimal design shows a reduction in link deflection 
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and driving torque. Instead of using traditional metal material, [Liao, Sung, 
and Thompson, 1987] design manipulator links by using composite materials. 
Link stiffness and damping are optimized by selecting proper design parame- 
ters for the fiber material, the type of matrix, fiber orientation in each ply of 
laminate, the fiber volume fraction, and the stacking sequence of the plies. A 
comparison between aluminum and composite laminate arm is conducted by 
[Choi, Thompson, and Gandhi, 1990]. The authors compare the performance 
of both arms through the motion control of single-link arms. According to the 
experimental results, the composite arm shows less settling time and smallei 
overshoot and consumes less torque. 

Despite the extensive effort reported above to solve compliant ma- 
nipulator problem, most of the approaches are still in early development 
stages and a great portion of them are limited to simple robotic structures 
such as one-link arms. For example, development of a simple, general robot 
controller suitable for both distributed and lumped parameter models have 
not been pursued. Additionally, the impact of robot geometry on vibratory 
mode control has seldom been investigated. Also, the majority of adaptive 
control of compliant manipulators focuses on one- and two-link planar arms. 
A more meaningful problem, adaptive control of spatial compliant manipu- 
lators, needs to be fully explored. In this report, we will develop controllers 
applicable to both lumped and distributed models. The effects of kinematics 
on vibratory mode conti'ol will be analyzed for a general compliant manipu- 
lator. Finally, an adaptive control law capable of on-line payload estimation 
and motion control will be designed. Case studies will be used to examine and 
illustrate our design and analysis throughout this report. 


Chapter 2 


Dynamic Equations of Rigid Robotic Manipulators 


Robotic system dynamic equations will be derived in this chapter. 
In the following derivations, structural compliance is neglected to facilitate 
the introduction of several handy tools that are essential to this report. The 
first section will present coordinate transformation matrix that transforms 
between local and global coordinate frames. Then two properties, the first 
and second order influence coefficients, are defined in the second and third 
sections. These two properties have compact and transparent nature that 
makes system dynamics easy to derive and verify. Finally, robotic system 
dynamics are derived by using the Lagrange method and further verified by 
the Newton-Euler method. 

2.1 Coordinate Transformation Matrices 

One of the frequently used tools in robotic research is coordinate 
transformation. Generally, a local frame is assigned to each link of a given 
robot. This local frame is useful in defining physical properties such as the 
junction point to the next link, the center of mass location, moment of inertia, 
and so forth. But to find the gross motion of a robot and the required driving 
force or torque, those physical quantities eventually need to be expressed in 
a common frame. Coordinate transformation matrix is a tool developed for 
this purpose. Figure 2.1 shows a floating link and its local coordinate frame 
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{.r,y,i}, where x, y, and z are three unit IV vectors defined in the global 
system { X y Y, Z } . A point p on the link is expressed by three local coordinates 


J _ 


e n 3 


where the superscript l indicates that the vector is defined in the local frame. 
The same vector in the global frame is defined by 

v = r x x + r„y + r z z 

i r * 

= [x y z] 


' v 

r* 


= T,r' 


( 2 . 1 ) 


In the above expression, T t e ^ 3x3 is the transformation matrix converting 
local coordinates to global values. Since the column vectors of T/ aie unit 
and orthogonal, T/ is a orthogonal matrix, that is 


TfT, = 


r x T x x T y x T z 

A. r F A r V A aT A 

y l x y‘y y l z 

-7' A aT' A aT A 

z l x z l y z l z 


(2.2) 


where I is a 3 x 3 identity matrix, therefore T, T = T t l . Apparently, to 
construct a coordinate transformation matrix, the unit vectors of a given 
local frame need to be identified first. Three basic rotational matrices aie 
often used in defining the local unit vectors. They are derived as follows. In 
Figure 2.2, S ly S 2 , and 5 3 represent three orthogonal unit vectors, where S i 
and S 2 rotate an angle 0 about S 3 to the new orientations S{ and S 2 - By 
simple inner product operation, the new frame {Si, S 3 ) could be expressed 
in terms of the original frame {5i, 52,53} as 

S[ = cos 8Si + sin dS 2 
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S' 2 = — sin QSi 4- cos 0 S 2 

S 3 = S 3 (2-3) 


Let S 3 represent one of {X,Y,Z}, and Si and S 2 represent the other two by 
following the right-hand rule relationship that Si x S 2 = S 3) then the three 
rotational matrices, Rot(S 3 ,0), converting {SJ, Sj, S 3 } back to {Si,S 2 ,S 3 } 


are 


Rot(X, 8) = 



■ 1 

0 

0 ' 


COS# 

0 

sin # 

— 

0 

cos # 

— sin# 

; Hot(r,«) = 

0 

1 

0 


0 

sin # 

cos# 


— sin # 

0 

cos # 


Rot(Z,#) 


’ cos 8 
sin# 
0 

. 


— sin 8 0 
cos# 0 
0 1 


(2.4) 


where the unit vector definitions X = [1 0 0] r , Y — [0 1 0], and Z [0 0 1] 
are used in the above derivations. In the above equation, Rot(S 3 ,#) denotes 
that the new frame comes from a rotation of 8 angles about an old frame axis 
S 3 where S 3 G {X,Y,Z}. Notice that in each rotational matrix, the column 
vectors are exactly the unit vectors of the new frame defined in the last 
frame, so they are transformation matrix. The application of these rotational 
matrices is illustrated in the following example. The original frame {X, Y,Z} 
rotates an angle a about X to a new frame {X\Y\ Z'}. Then the new frame 
rotates an angle # about Z' to the third frame {*", Y", Z ") . To find a matrix 
T transforming the third frame back to the original frame, the rotational 

matrices axe multiplied together as 


r = Rot(A»Rot(Z',#) 


(2.5) 


Notice that the order of matrix multiplication must be obeyed in computing 
T. Another example is to find the transformation matrices of the three-link 
arm shown in Figure 2.3. In this model, each link is labeled with a local 
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frame {A,-, Y it Z,}, i £ {1,2,3}, where the first joint is revolute and rotating 
about the second joint is prismatic and sliding along Z 2 , and the third 
joint has Z 3 as pivot axis. Let {X 0 ,Y o ,Z 0 j denote the global frame, and T t 
be the transformation matrix converting the ith frame to the global frame. 
Then 

Ti = Rot (Z o ,0 { ) 

T -2 = !Z\Rot(31,90) 

T* = T 2 Rot(A' 2 ,9O)Rot(Z 3 ,0 3 ) (2.0) 

Let {.?•,, i/,, z, } denote the unit 7v 3 vectors of {Al.l^Z,}, i £ {1,2,3}, then 
the above transformation matrices give the unit vectors in terms of global 
coordinates by the relationship 

T, = [r. /), i,-] (2.7) 

2.2 The First Order Influence Coefficients 

In this section, two compact notations will be introduced to define 
the translational and angular velocities of a moving robot. In Figure 2.3, let 
P £ Tv 3 be the global positional vector of a given point p within the payload, 
and also let 4* £ R A be tin* Euler angles of the payload. Then the velocities 
of point p are 

01 ‘ 

02 
03 . 

= tG p 0 (2.S) 

and 

• . <9<I> <94> 

^d0i de 2 ddj 6 

def r* h 
— ll&pV 


p = 

d0\ 00-t doj 


(2.9) 
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Figure 2.3: 3-Link Rigid Robot Modeled with Local Coordinate 
Frames 


2G 


where 0 = [0 l 0 2 Oj] T <E ft 3 , and r G p E 7v 3x3 is defined as the first order 
translational influence coefficient, or translational G function, of p. Similarly, 
rG p E P 3x3 is the first order rotational influence coefficient, or rotational G 
function, of p. The details of T G p are given next. According to Figure 2.3, 

P ~ + $2 ~2 + hi /a ) 

= h-i’i d ^2 ~ 2 d fly z 2 d- hfjj 

— U{Q\Z\ x d'i) -f 0- 2 z 2 + 0 i{ 0 \ z i x z 2 ) d /;)(<?iZi x y :( -f- ^323 X //■( ) 

= [(*i x P) (*;t x /aj/;,)]^ 

= tG v 9 (2.10) 


A comparison between Equations 2.8 and 2.10 produces 

dP „ _ dP , dP „ , . 

00, ~ ZiXP ' d o 2 - Zi ; ^ - 23 x (2-11) 

Apparently, the influence of a unit on P is the cross product of the joint 
1 pivot axis and the moment arm between joint 1 and p. Similarly, joint 3 
is revolute, so every unit 6 f t adds a 53 x / 3 y 3 vector to P. Since joint 2 is 
prismatic, the contribution of unit 0 2 to P is simply z 2 . Such results could 
be explained by the definition of partial differentiation. Recalling that 

0} = ivm.9tanf .63 =ro 11 stnnt 

which means that the above partial operation is taken at fixed 0 2 and # 3 . 
In Figure 2 . 2 , the effect of unit variation of 6 1 on P with fixed 0 2 and #3 is 
exactly £1 x P. Similar explanations could be given to the partial operations 
on d 2 and 0 3 . Following the interpretations and also example results, a general 
translational influence coefficient table is constructed below. 


o«, ' a#, M 
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Table 2.1 Translational G Functions: jGj 

ith Joint Type 

( rGj), 

Conditions 

Revolute (R) 

Si x r tJ 

* < j 

R 

0 

j < i 

Prismatic (P) 

£ 

i < j 

P 

0 

j < i 


In the above table, T G ) denotes the translational G function of any point on 
the jtli link and ( rGj), is its ith column vector. Also 5, is the unit vector 
of the ith joint axis, and r tj is the positional vector from the ith joint to 
the particular point on the j th link. For an n-link robot, xGj € Tv, , and 
i, j e {1,2, • • • , n}. Equation 2.11 results could be verified directly from Table 
2.1. A similar table can be built for rotational G function, but the details of 
Equation 2.9 are worked out first. 

$ = [^O f 3 ]0 

= rG p 9 ( 2 . 12 ) 


The above results could be checked easily. Since each revolute joint con- 
tributes to <i? an angular velocity around the joint axis, z\ and z 3 constitute 
separately the first and third column of nG p . However, joint 2 is prismatic 
which does not change the orientation of robot, so the second column of nGp 
is a null vector. The content of a general rotational G function is tabulated 


below. 


Table 2.2 Rotational G Functions: nGj 

ith Joint Type 

( nGj), 

Conditions 

R 

s t 

* < j 

R 

0 

j < i 

P 

0 

i < j 

P 

0 

j < i 


where i, j G {1,2, • • • ,n} for an n- link robot. Obviously, only revolute joint 
contributes angular motion to a given robot. However, a revolute joint affects 
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only the part of robot located at the downstream of the particular joint. This 
means that if the ith joint is revolute then it only affects the orientation of the 
jth link with every j > i, otherwise ( R G 3 ) t = 0 for all i > j. This simple but 
important fact will be applied to the derivation of the second order influence 
coefficients introduced in the next section. 


2.3 The Second Order Influence Coefficients 


In the last section, G functions arc introduced from velocity deriva- 
tion. In this section, the second order influence coefficients, or H functions, 
will be defined from acceleration equations. First, the translational velocity 
of the three-link example, Equation 2.8, is differentiated with respect to time 
which produces the translational acceleration 


def 


rGp°+ rC„0= r G p 0 + d&^)l(^)]0 


r G v 0 -f [0, 0 2 0,} 
rGj + 0 T T Hj 


a 2 p 


\ivd0i dr 002 ' dr O 0 3 - 

a 7 p a 2 p 


0 


dO*dO\ 

aV 

dOodOi 

d 2 P 

00*30 , 

aV 

dOxdOi 

aV 

aOodO? 

fir 

00*302 

efir 

dO x 30 a 

30-2 303 

30*30* 


(2.13) 


where jH p is a 3 x 3 x 3 matrix and is defined as the second order translational 
influence coefficient, or simply translational H function. For an n-link robot, 
G 7v 3xnXn ; furthermore, let ( rH p )ki be the A*th row and ith column 
element of rH p , then 

( rH p) ki = oe^M G 

which means that jH ' is a Hessian matrix. The entries of tH p in Equa- 
tion 2.13 are developed in the following equations. The first column of jH 
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is obtained by the relation 

d ,dP 


&) = tS*' x 


dt V 3$i 


dt 

= i\ X P + Z\ X P 

— Zi X [01^1 xP + 02^2 + 03(^3 X ^3^3)] 
£l X (Zi X P) ] 

= [0i 02 03] | Z\ X Z 2 

Z 1 X (£3 X ^ 3 1/3) 


(2.14) 


where £1 = 0 and the second vector in the above equation is the first column 
of rH p . Similarly, 

d . dP . 

d^ 30 2 ^ ^ 

= 0i£i x £ 2 

£1 x £ 2 

= 0 T I 0 (2.15) 


and 


± { ° L ) 

dr 303 ; 


0 


= ^(^3 x / 3 y 3 ) 

clt 

— £3 x /3D3 + 23 x /sy 3 

= 0 i(£i x £3) x hy 3 + 23 x / 3 (0i2i x y 3 + 0 3 23 x y 3 ) 

= 0 i/ 3 [( 2 l x £3) X 1/3 + £3 X (£1 X y 3 )] 

+ 03/323 x (£3 x y 3 ) ( 2 - 1G ) 


The last equation could be further simplified by using the vector triple prod- 
uct identity that ax{bxc) = (a ■ c)b - (a ■ b)c for any ft 3 vectors a, 6, c defined 
in an orthogonal frame. Therefore, from Equation 2.1G, 


(£1 x £3) x y 3 + £3 x (£1 x y 3 ) 

= — (y 3 • £ 3)21 + ( 1/3 • 21)23 + (23 • — (^ 3 ' 

= £1 X (£3 X y 3 ) 


(2.17) 
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and hence 

z 1 X (£3 X / 3 y 3 ) 

0 

. Z 3 X (z 3 X / 3 y 3 ) 
By combining the above results, rH p is given by 


E(EL\ = 

dvoe 3 ) 


= 


a 2 P 

d 2 p 

d 2 P ] 

de v d$i 

aV 

9$ z d0i 

99*99 1 
9>P 


d0\S$2 

9>P 

902^02 

96*902 

9*P 

aV 

_ B6\ 90s 

d&2 ®0$ 

dOsdOz . 


*1 x (£3 x / 3 y 3 ) 
0 

£3 x (£3 x l 3 y 3 ) 


( 2 . 18 ) 


( 2 . 19 ) 


Z\ X (£1 X P) Z\X £2 

£1 x z 2 0 

£ 1 X (£3 x /3J/3) 0 

Actually, following the kinematic relation of a given robot, the entries of a 
general translational H function could be constructed directly from the next 


table, 



Table 2.3 Translational H Functions: 7 

'Ei 

fcth 

Joint Type 

£ th 

Joint Type 

( tG } ), 

( 1 -HX 

Conditions 

R 

R 

Si 

X I'ij 

Sk X {Si X Vij) 

k < i < j 

R 

R 

Si 

X I'ij 

S{ X (S k x ) 

i < k < j 

R 

R 

Si 

X I'ij 

0 

1 <J < k 

R 

R 


0 

0 

j < i, all k 

P 

R 

Si 

x r tJ 

0 

k <i < j 

P 

R 

Si 

x r, j 

■S’, X S k 

1 < k < j 

P 

R 

Si 

X I'ij 

0 

V 

’ 

VI 

P 

R 


0 

0 

j < ly all k 

R 

P 


s, 

S k x 5, 

k < i < j 

R 

P 


Si 

0 

A > i and j > 2 

R 

P 


0 

0 

j < 1, all A: 

P 

P 


Si 

0 

i < j, all A; 

P 

P 


0 

0 

j < i y all A 


In Table 2 . 3 , T H 3 represents the translational H function of a given point 
in the j th link, 5, and Sk are respectively the 2th and kth joint axes, r ( j 
is the position vector between joint t and the particular point on link j , 
^ A j and { j )ki G ' 1 ^? is the Ath row and zth column element 
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of T Hy For an n-link robot, k,i € {1, 2, •••,«}• In the third column of 
Table 2.3, the T G, listed in Table 2.1 axe repeated for clarity. Obviously, the 
values of ( T H ,)*, rely on the geometric location of link j and joints i and 
jfc as well as the joint types of i and k. Notice that T H J is symmetric, i.e., 
( rHj)ki = ( which could be observed from Equation 2.19. 

From Equation 2.12, the angular acceleration of point p is 


$ = rGJS + 9^' rH p9 


( 2 . 20 ) 


where 


r a 2 * a 2 » a 2 * 


ae,a«i 

a 1 * 


90*86\ 

a 1 * 

dOidBi 

dO%d$ 2 

803.803 

a 2 * 

dOidOi 

d$2 dfa 

do$ d$$ 

0 0 

z\ x h ' 


0 0 

0 


0 0 

0 



( 2 . 21 ) 


Similar result could be obtained from the following rotational H function 


table. 


[ Table 2.4 Rotational H Function: 

nHi 

k th 

Joint Type 

ith 

Joint Type 

( R G i)i 

( 

Conditions 

R 

R 

Si 

Sk X Si 

k < i < j 

R 

R 

Si 

0 

k > i and j > i 

R 

R 

0 

0 

j < t, all k 

p 

R 

Si 

0 

i < j y all k 

P 

R 

0 

0 

j < i, all k 

p 

P 

0 

0 

all i, j, k 

R 

P 

0 

0 

all i, j, k 


As mentioned before, a prismatic joint does not change robot orientation, so 
( RHj) ki = 0 when the fcth or ith joint is prismatic. Also, a revolute joint 
only affects the motion of its downstream links, so ( = 0 when the kth 
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joint is revolute and k > i. This simple relation makes R H } asymmetric as 
shown in Equation 2.21, i.e., ( n H j) ki ± ( R Hj) ik , although R H j is a Hessian 
matrix. 


2.4 The Lagrange Dynamic Equations 

The G and H functions defined in the last sections will be very 

handy in formulating the robotic system dynamics that will be derived by 

the Lagrange method in this section. For an n-link robot, let a, denote 

the generalized actuator force at the r'tli joint, that is, when the ith joint 

is prismatic then t», represents the joint actuating force, or, if the ith joint 

is revolute then u* is the joint driving torque. Also, let be the ith joint 

displacement, and 6 be an n-dimensional vector with 8 X as the ith element. 

Then the Lagrange dynamic equations are given by 

d dKE dKE dPE 

dO t ^ ~d9~ + ~d9~~ Vi (2 ' 22) 

where KE and PE are system kinetic and potential energy separately. In 
the following deiivations, only inertial dynamics arc considered, and actua- 
tor forces are the major forces driving the system. The dynamic equation 
derivations will be divided into kinetic and potential energy parts. 

2.4.1 Lagrange Dynamics of Kinetic Energy Part 

For a general serial robot, let P } be the center of mass location of 
the jth link, and be the angular- velocity of the same link. Both Pj and 
are K 3 vectors measured with respect to a given global frame. Then the 
kinetic energy has an expression of 

KE = \ + (4j) T /,6j] 

j= i 


(2.23) 
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where mj is the mass of the j th link, 7, is the moment of inertia computed 
with respect to the jth link center of mass and defined by the jth link local 
frame, and the superscript j indicates that the physical quantity is defined by 
the jth local frame. In Equation 2.23, N denotes the total number of links, 
and payload could be treated as an additional fixed link attached to the robot 
gripper. Let Tj be the coordinate transformation matrix transforming the jth 
local frame back to the global frame, then 

= rQjB 

= Tj&j (2-24) 

and by the orthogonal matrix property that Tj = T~\ is given by 

<jd = Tj nGj (2.25) 

In the above equations, the angular velocity is expressed in terms of rotational 
G function. Similarly, P, = T Gj6 could be introduced into the KE definition 
in Equation 2.23 which becomes 

KE = -^2(mj0 T tGJ tGjO + 6 T nGjTjljTj' R Gj0) 

2 j=\ 

= f -e T re (2.26) 

2 

where 

/• = t GJ tGj + rGJT^TT n G,) € K" 11 " (2.27) 

J=1 

Notice that /* is function of 6 only, i.e., I* = /*(0), besides that since K E > 0, 
J* is a positive definite matrix and 7* = (7*) T . The kinetic energy part of 

Equation 2.22, i.e., 

ddKE dKE 
JE dBi ’ dd, 
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is further divided into a sum of mass and moment of inertia components, or 

d dKE dKE _ d dKE m dKE m ddKE t 8KE , 

dr d$i } 86, “ dr ae , 86, + dr de, ~ 86, 

where 

KE m = -^2rn,j6 T T Gj rGjO (2.28) 

£ i= i 

I<E, = W$ T HGjTjljT? K Gj (2.29) 

J = 1 

•Derivation of f t (^-KE m ) - £-KE m 

Let ( rGj)i denote the ith column vector of and ( rGj), £ 7 Z 3 , 
then a substitution of the KE m expression defined by Equation 2.29 into 
(a| ~ KE ™ ) Produces 


8KE m 

86 , 


= E m >( tGj)J rGjd 


j=i 


then the time derivative of the above equation results in 


(2.30) 


d dKE, 
dr de. 


N ( n n2 p \ T N 

- £"'(£***) TC j * + gm J ( T C j )f rCj i 


i=i 


N 


+ E m ,(TG i W rH,e) 

J = 1 


(2.31) 


where the second order partial ( a f* dS Pj) is the second order property of Pj 
which is exactly the I'tli row and ith column entry of tH ■ given in Table 2.3. 
Similar second order elements will show up in (d~-KE m ) which is 


8KE m A f " 8 2 P } • 


7’ 


i=i 


< 90 , ^ 

Since translational H function is symmetric, then 

8 2 Pj _ a 2 P, 

86 $ 9 k 86 k 8di 


6 k tG,6 


(2.32) 
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therefore, the second order terms in Equations 2.31 and 2.32 are canceled in 
the final dynamic expression of ICE m which is given below 

±( 9K $1) - = f>,( T Gi)T t G,i> + mj( t G,)J(.9 t T H,e)\ (2.33) 

dt y d$i W U 

.Derivation of 

Set ( rGj), be the tth column vector of R Gj and ( R Gj), € Tv 3 , then 
from Equation 2.29, 


d OKE,) = £ ( r6 . )Jt , IjT J rGj 0 + £( „«,}FT, K G,9 

dt d$i j-i i= 1 

+ B RGifTjljtT nGj + £( nG,)]T,I,Tj ,,G,« 
i = i ■’ 1 

+ B n G,)?'T,7, TT(0 T nHfi) (2.34) 

j =1 

It will be shown that the third term in the right-hand side of the above 
equation is actually zero. According to Equation 2.7, the transformation 
matrix T ) is composed of the local unit vectors 

Tj = [ij Vj $ } ] 


N 


N 


Since the unit vectors {Xj.y^Zj} change orientation due to the angular mo 
tion of link j , Tj is given by 

Tj = pj x Xj) (QjXVj) ($> x z ; )] 


Also by the G function definition, 

4>j = rGjO 

then the (Tf rGjO) part in the third term of Equation 2.34 could be expanded 
into 


' ($j X Xj) T $j 1 [ ($j X .Tj) • 4>j ’ 

fT r gJ = Tj <£ j = (^xyj) T $j = ($ 7 x y 3 ) • f , 

(<jj x z } ) T i > 3 J x z } ) • $j J 


(2.35) 


36 


Following the vector product identities, (ax b)- c — (cx a) ■ b and <i> ; x = 0, 
Equation 2.35 results in a null vector, so the third term in Equation 2.34 


vanishes. Further reduction of Equation 2.34 is possible after introducing the 


following expansions. First (^- KEj ) is expanded into two terms 

BJ W ” 

+ p T »Oj(^)l t Tr n G,0 

In the second term of the above equation, it can be concluded from robot 


( 2 . 36 ) 


kinematic relation that 


dTj _ J 0 is prismatic or revolute but i > j 

d6i \ [(Sj x Xj) (S, x y-) (S,- x £j)] 0, revolute and i < j 

So the following analysis concentrates on the case where 8, is revolute and 


i < j . Since ( IjTj rG 3 8) € 7v 3 , let 


then 


h T J RGjO = 


Cl 
C 2 
^3 


€ ft 3 


-QfihTj RGjB) = (Si x ij)c! + (Si x y } )c 2 + (S, x z : )c 3 




’ Cl ’ 

\ 

Si X 

[*j Vj S j] 

C 2 




- C 3 . 

) 

S, x (T,I,TJ „G,0) 

(2.37) 


therefore the second term of Equation 2.36 could be expressed as 

= ■£i r [S i x(T i I i TT RGj e)] 

j = 1 

= jr -S< ■ [*,• x (TjljTj „<?,<*)] 

j= 1 


(2.38) 
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It is now shown that the above equation has a negative counterpart and is 
neutralized in the final expression of 


d (3KE t \ _ dICE l 

Jt V d9i ) de i 


Subtracting the first term of Equation 2.36 from the first term of Equa 
tion 2.34 produces 


f .’rr'/’ £** (gs; "Cf) r.r ,Tf < 

- I(sS'-sS‘) ■“'» 


(2.39) 


where each second order partial term represents an entry of rotational H 
function listed in Table 2.4. By Tables 2.4, it can be shown for revolute 0, 


that 

d 2 $j _ ( 6 k S k x Si \{ j >i> k 

d 9 k ddi { 0 otherwise 

d 2 $ } _ j Si x 6 k S k if j>k>i 

d$id$ k \ 0 otherwise 

where 

f 1 if e, is revolute . t g (1 , 2 ,. . . (2.40) 
° k ) 0 if 6 k is prismatic 

For j > i, the second order terms in Equation 2.39 have the following compact 
results 


n . J2_ 

d’*i A 

d 6 ,Bh k 



/I 

d 2 <bj d 2 $j 

] 

r g»$. d^ j 

3 2 $j 


ll 

36 x ~d6i 36266 1 

36 n d6i J 

" d6i36 x 36,392 

A i. v _ 1 

39i36 n 

j 


= (PiSi x Si) (6 2 S 2 x Si) • • • (Si-Ji-t x Si) 0 • • • 0 ] 


- [0 • • • 0 • (Si x 6 ,+iSi+i) (Si x 6 i+ 2§i+i) • • • (‘S'. * s i$i ) 0 • • ' 
= [(tfiSi X Si) (S2S2 X Si) • • • (SjSj xSi) 0 • • • O ]0 
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= -Si x ([5,5, hS-i ••• SjSj 0 ••• O]0) 

= -Si X (2.41) 

where according to Table 2.2 and Equation 2.40 

= [5,5, 5 2 5 2 • • • SjSj 0 ••• 0]#> (2.42) 

In Equation 2.41, the fact that S, x 5,- = 0 has been used to complete the 
formulation. Then Equation 2.39 becomes 

YH-S,xi,)-(T,I,Tj nGj) 
j = 1 

= E-Si • |4j X „C>)] (2.43) 

J = 1 

which is exactly the counterpart of Equation 2.38, and both will cancel each 
other in the final form. Notice that although the above derivations arc mainly 
for revolute 0, and j > i, the cancellation is still valid for prismatic 0, or 
revolute 6 , when j < i, because both terms are identically zero in these cases. 
After eliminating all zero terms, the dynamic equation of KEj part reduces 
to 

d_ (dKE,\ dKE i 

<lt V 00, J 09, 

= E( X (TjIjTj „G,6) ] 

i=i 

+ B kGMT,I,TT)( n G,» + » r „H,9)] (2.44) 

i = 1 

The final KE part dynamic equations are the sum of Equations 2.33 and 2.44 
which are 

d (0KE\ dKE 
dt \~d0~ ) ~ d0, 
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= •£ mj( T G)f( rGj + 0 T THj) 

i - 1 

+ XX nGi)n*i x (TjljT? bGM 

J = 1 


+ D nGM T i I > T D( » G ^ + « T 

i=i 


(2.45) 


2.4.2 Lagrange Dynamics of Potential Energy Part 

It is assumed that gravity force is the only external force on the 
system and the gravitational field is along the global Z direction. Then the 
gravitational acceleration vector is defined by g = [0 0 g] T € H 3 where g is 
the acceleration constant of gravity. The gravitational potential energy of the 
jth link is given by 

(PE)j = rrijPj’g 


then 


and 


N 


;=l 


n dp? 

V" ... 1 Z 


(2.46) 


dPE 

dQi ~ hi 1U 1 de > 


= 

i=i 


(2.47) 


With the above result and Equation 2.45, the dynamic equation for the ith 
actuator is 


dt 
N 


d (dKE\ dKE dPE 
\ld~ ) 69 t + 


ddi 


= '£m J ( T G)i( T G J 6 + d T THj) 

j= i 
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+ £( pGiWi * (T.IjTj R Gfi)\ 

J = 1 

+ £( nGMWi?)( RG,i> + e T rH,0)} 

i=i 

+ £ m j( TGj)Jg (2.48) 

i=i 

Let v be an n-dimensional vector with a, as the ith element, and recalling 
that ( rGj)i and ( nGj)i are the ith column of ^Gj and rGj respectively, 
then for an n-link robot the total inertial dynamic equations are 


d fdKE\ dI<E dPE 

~ dt VIm - ) a« + bo 

= /•« + £ ’», t G](6 t rHj) + •£ „GT[$, x {T^Tj R Gj)} 

j= 1 J = 1 


+ £ nGjmiiT ? )(# T rH,«)) + £-«,( rG,) 7 ^ 

)=■ j=i 

where I" is the generalized inertial matrix defined by Equation 2.27. 


(2.49) 


2.5 The Analogous Newton-Euler Dynamics 

The dynamic equations derived by the Lagrange method will be 
reconstructed by the analogous Newton-Euler approach in this section. The 
Newton-Euler method will verify the Lagrange results and also provide the 
dynamic equations with a physical interpretation. The linear momentum of 
the j til link is vijP, then the associated inertial force is 

= m )P} 

= m,j( rGjO + 6 T T HjO) <E ft 3 (2.50) 

where P, is replaced by the G and H function expressions defined in Equa- 
tion 2.13. To support this inertial force, the ith joint needs to generate a 



generalized actuator force whose magnitude is given in the following 

three cases: 

Case 1. If i > j, then the ith joint is located downstream of the jth link, so 
the inertial force creates no effect on therefoie, ( ) f 3 0. Howevei, 

from Table 2.1, ( r Gj)t = 0 at t > j, hence could be expressed as 

(®i)F, = "V( &)?( tOjO + 6 T r Hfi) 

Case 2. The ith joint is prismatic and i < j, then (t'i)F, is a force given by 
the projection of Fj on the ith joint axis S,, or 

Mx = S?F } 

= mj( rGj)J ( rGjfi 4 - 0 T tH j9) 

where ( T Gj)i = S, is listed in Table 2.1 under the condition that i < j. 

Case 3. The ith joint is revolute and i < j, then (v,)fj I s a torque created 
by 

(vi) F} = Si • (r,j x Fj) 

— (5. x i'ij)' 1 Fj 

= vij( rGj)l ( tGj6 + 9 T tH j8) (2-51) 

where r.j is the positional vector between the ith joint and the center of mass 
of the jth link. The vector triple product identity a • (6 x c) = (a X 6) • c 
is applied in the above equation. For any of the three possible cases, (u,) Fj 
could be expressed by the unique form in Equation 2.51. 

Let /ij be the angular momentum of the jth link evaluated around 
the center of mass, where /ij E F 3 and is defined in the jth local frame, then 
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which could be converted into a global frame description h } by 

hj = Tjh j j 

— TjljTj R Gjd f2.53) 

Set Tj be the inertial torque associated with hj and tj e 7v 3 , then 



= 7 t W I ’ T ! « G j) 

= TjI } Tj r Gj9 + TjljTj r G 3 6 

+ TjljT J ( R Gj$ + 6 T R Hj0) ( 2 . 54 ) 

According to Equation 2.35 results, Tj R Gj0 = 0, so its accompanied term 
in Equation 2.54 vanishes. Also, 

TjIjTf r Gj0 = x (TjljTj r G : 6) (2.55) 

then Equation 2.54 becomes 

r, = ij X {TjljTj nGjS) 

+ TjljTj ( r Gj 9 + 9 T R H jd) (2.56) 

Let (i\ ) Tj be the generalized actuating force at the ith joint to support t } , 
then its value is decided in the following two cases: 

Case 1. If the zth joint is prismatic or revolute but i > j } then r, has no 
effect on (u,) Tj , so (u,) Tj = 0. Since by Table 2.2, ( R G 3 )i = 0 in this case, 
(v,) Tj could be written as 

( V ,)rj = 0 • Tj 

= (nGjffrj 
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Case 2. The tth joint is revolute and i < j, then (u,) r> is the projection of 
Tj on the tth joint axis 5,, or 

M’, = SJ Tj 

= (rG^t, (2.57) 

where the fact that ( p.Gj)i — Si is used in the above equation. Since in both 
cases, has the same expression as in Equation 2.57, so the Tj given in 

Equation 2.56 is substituted into Equation 2.57 to produce the final form 

Mr, = ( BC, •)?■[*< X (TihTf rG,4)\ 

+ ( K GM T ,hTjK R Gfi + « T rH,«)\ (2.58) 

Finally, for the gravity force, let ( u,) Si denote the tth joint force 
supporting the gravity force of the jth link, then 
Case 1. If j < i and t is either revolute or prismatic joint, then 

(vj) gj = 0 • iiijg 

= ”b( rGj)Jg 

Case 2. If j > i and the tth joint is prismatic, then 

= mj§?g 

= m.j( t Gj )] g 

Case 3. If j > i and the tth joint is revolute, then 

= rnjSfirijXg) 

= rrij(Si x rjj) T g 
= m.j( T Gj)Jg 


(2.59) 
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All three conditions result in the similar form as Equation 2.59. Let u, l>e 
the sum of (vi) F} , (v { ) Tjt and for all j € {1,2,3, N}, then from 

Equations 2.51, 2.58, and 2.59, 

N 

V i = E^*')^ + (U,)r, + (Ui) S; ) 

7 = 1 

= E m i( tGj)J ( tGjO + e T r H j$) 

7 = 1 

+ E( x ( r 7 W hG^) + (TjIjTf)( R G s e + r ,<?)] 

i=i 

+ E m j( T Gj)Jg (2.60) 

7=1 

which is exactly the same result derived by the Lagrange equation in Equa- 
tion 2.48. Notice that in both results, 9 and 9 are decoupled from position 
dependent parameters in the dynamic equations. A physical interpretation 
of Equation 2.60 is given here. In the first term of Equation 2.60, 

mj( T G } 9 + 9 T T Hj9) 

represents the inertial force on the j th link, where 

( t Gj9 + 9 T t Hj9) 

denotes link translational acceleration, and ( jGj)i is the projection vector 
projecting the inertial force on the i th joint. Similarly, in the second term 

x {TjljTj R G,e) + (TjljTfX nGj + 0 T n H ,6) 

is the inertial torque on the j th link due to angular acceleration of the link, 


( Wfx rG,» + F RHj) 
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and also due to the change of moment of inertia magnitudes in the global 
frame, which is 

x (TjIjTT r G } 8) 

and ( is the projection vector projecting the inertial torque to the ith 

joint. A similar interpretation could also be given to the gravity force term. 
Although the geometric location order between the ith joint and the j th 
link and the joint type will affect the final projected value, such problems are 
solved automatically by the contents of projection vectors ( n Gj)i and ( T G } ), 
as shown in the previous case discussions. Therefore, the above dynamic 
equations are general for any i and j due to compactness of G and H functions. 

2.6 Summary 

In this chapter, rigid robot dynamic equations are dei'ivcd by both 
Lagiange and Newton- Euler methods. The purpose of presenting rigid system 
dynamic equations is to help the reader to got acquainted with the notation 
and tools used in this report. One of tin; most useful tools, the coordinate 
transformation matrix, is introduced first to assist the identification of local 
cooidinate fiame. Then, the first and second order influence coefficients, G 
and H functions, are defined. Simple kinematic relations are used in con- 
structing and interpreting the entries of both functions. Finally G and II 
functions are applied to system dynamics derivation. One advantage of intro- 
ducing the G and H functions is the compactness of these notations. Besides 
that the G and H functions carry the kinematic relations required to define 
robot motion and actuator driving force. The physical interpretations of the 
final dynamic equations are given in the last section. Finally, it should be 
pointed out that the G functions also produce the “partial velocities” and 
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“partial angular velocities” defined by [Kane and Levinson, 1985], which can 
be proved directly by using the d’Alembert’s principle and the principle of 
virtual work. 


Chapter 3 


Dynamic Equations of Compliant Robotic 
Manipulators 


In the previous chapter, we developed system dynamics for rigid 
robotic manipulators. Physically, no system is absolutely rigid under load. 
The assumption of rigid body is to simplify system model so that an effi- 
cient dynamic description could be obtained with acceptable level of accu- 
racy. One of such occasions that a rigid body model becomes a practical 
approach is when the system has negligible deformation. For example, the 
rigid body model is suitable to most current industrial robots which are built 
with rugged arms but carry small payload and operate in low speed. How- 
ever, the rigid body assumption is not realistic when structural deformation 
becomes prominent and consequently affects operation precision. An obvious 
case where rigid body assumption becomes impractical is in the modeling of 
a lightweight robot. To increase productivity and economic value, the next 
generation robots tend to be lighter, faster, and have better precision while 
carrying larger payloads. Due to the lightweight nature, a heavy payload 
plus high speed will cause structural deformation and vibration. To maintain 
precision, it is essential to have a compliant model to help system and control 
designers solve the structural deformation and residual oscillation problems. 
The aim of this chapter is to present system dynamics of robotic manipulator 
modeled with structural compliance. 
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3.1 Distributed Parameter Model of Compliant Ma- 
nipulators 

There are two popular methods of describing manipulator compli- 
ance. The first method is the distributed parameter model, and the second 
method is the lumped parameter model. This section will introduce the dis- 
tributed model and save the second method for a later section. Although the 
distributed model is used mainly on link compliance, for the completeness 
of the derivation, joint compliance is also included in the following analysis 
where lumped massless spring is employed to represent joint compliance as 
suggested by [Good, Sweet, and Strobel, 1984]. The distributed parameter 
approach defines each robotic link as a continuous beam. Link deformation 
is analyzed at every point along the link. Then an integration of all points 
in the link gives the gross vibratory motion. A detailed derivation of compli- 
ant manipulator dynamics by the distributed model is reported by [Graves, 
1988]. This report will present a simplified version of compliant manipulator 
dynamics based on the following assumptions. It is assumed that (1) each 
compliant link has a large slenderness ratio so that the Euler-Bernoulli theory 
is applicable, (2) small deflections, and (3) deflections are decoupled in all di- 
rections. According to the first assumption, the rotatory inertia and shearing 
effects are negligible. And by the third assumption, coupling effects like the 
centrifugal stiffening is neglected in the analysis. The link deflections mod- 
eled in this section include lateral bendings in principal planes, longitudinal 
elongation, and twisting along axial direction. Also, each joint compliance is 
modeled by a lumped spring. The Lagrange method will be applied to de- 
rive the compliant system dynamics. As a representative analysis, the kinetic 
and potential energy axe derived for the compliant link j shown in Figure 
3.1. In this example, a given point p deflects from its rigid link position to 




Figure 3.1: Distributed Model of a Compliant link 
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a deformed position p' . {xj,yj,zj} is the fixed local frame before deforma- 
tion, and {x'-,j is another local frame attached to the distal end of the 
deformed link. Both frames are parallel when the link is absolutely rigid. 
Figure 3.2 shows the Xj — Zj plane view of Figure 3.1. According to the third 
assumption, Figure 3.2 represents the link bending along Zj direction. In the 
same figure, N — N is the neutral surface, and p is a point on the neutral axis 
located at a distance r from the fixed local frame. Let 8 denote the deflection 
vector from p to p', and {xj, y-, Zj) be the unit 7V vectors of {xj, t/j, Zj}, all 
unit vectors are defined in the global frame, then 8 is composed by 

8{r,t) = 8 x (r,t)£j + 8 v (r,t)y j + 8 z (r,t)zj 6 TV (3.1) 

which indicates that 8 is a function of position and time. In the above equa- 
tion, {6 r , £„,&,} are the deflections of p along y •, ij}, where 8 y and 8 Z 
represent the lateral bendings and 8 X is longitudinal elongation. Now, let 
a x (r,t) be the twisting angle of the cross section at point p along x,-. Then 
the linear and angular velocities of point p' are derived in the followings. Let 
Oj be the global position vector of the j th frame, and P and P' be the global 
position vector of p and p' separately, then 

P' = 0, 4- rij +8 <eTV (3.2) 

and 

P' = Oj + rxj + r£j + 8 

= P + 8 (3.3) 

Note that if the jth joint is revolute then r = 0, if the j th joint is prismatic 
then r — 8j + where 8j is the actual joint displacement, and f3jo is the 
joint deflection. Let Uj and be the angular velocity of point p' and p 
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respectively. Since the rotatory effect is ignored, the angular velocity of p 
has the form 

= ( i* j 4- dt x (v,i)xj € ( ) 

Notice that the joint compliance effect is included in i.e, a term is 

contained in if the jth joint is revolute. For the incremental segment sur- 
rounding p' in Figure 3.2, let dm(r) be the mass of the segment and dl(r) be 
the associated mass moment of inertia with <tl( r) 6 *“*. then the kinematic 

energy of the segment is 

2 dKEj = P' T P'dm(r) + ujTj{d.I(r))Tjuj ( 3 - 5 ) 

The above derivation is general for any given point p at 0 < » _ 
integration of all such segments over the whole link length L gives the kinetic 

energy of compliant link j, which is 

2 KEj - JP' T P'dm + j {wjTj(dI)T T Uj} 

= J P T Pdm + J P T 8dm + J 8 T Pdm + J 6 T 8dm 
+ J *jT j (dI)Tf* j + J (d x Xj) T Tj(dI)Tj 

4- J $jT,(d/)T, T (dxij) + J (a**j) T Ti( dI ) T J (***;) (3 6) 

where the part 


J p T Pdm + J 

is the rigid link kinetic energy. According to the first and third assumptions, 
it is shown by [Low, 1987] that the gravitational and clastic potential energy 

are given by 

PE, = j P' T gdm + i J El/~?dr + 2 / 

+ \jEA^fdr + \jGj/^ + \l<^ (3.7) 
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where E and G are separately the moduli of elasticity and rigidity, A is the 
cross section area, I y and I z are the area moments of inertia about y } and z } 
respectively, J x is the polar moment of inertia along K ]0 is the stiffness of 
modeled joint spring, and g £ 7l 3 is the gravitational acceleration vector. In 
Equation 3.7, the rotational angles a v and cv* arc given by 


08, 




cv. 


_ 08 y 

Or 


(3.8) 


which represent the rotation angles around y ■ and Zj respectively. The grav- 
itational term in Equation 3.7 could be further divided into 


J P' T gdm = J P T gdm + J 8 T gdm 


where the first term is the gravitational potential energy of rigid link. To 
include rotatory inertia effect into the kinetic energy expression, Equation 3.4 
is modified by 

u>j = <i>j + d x Xj + ny )j -| n z Zj e Tv 3 (3.9) 


then the in Equations 3.5 and 3.G are replaced by the above new defini- 
tion. In order to simplify flexibility dynamics of a continuous system, a finite 
number of assumed modes are generally employed to discretize the deflections 
which actually contain infinite degrees of freedom. Therefore, it is assumed 
that the deflections could be expressed by decoupled forms 


*>x = 

1=1 

ny 

6 v = 

1 = 1 
nz 

t = l 
na 

~ ^ y /^jor t (Q fijat ( ^ ) 

i'=l 


(3.10) 
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where {<f>j x i, <f>j y >,<}>jzi,4>jai} are the ttli mode shapes of {<5 X , 8 y , <!>*, a r } and are 
functions of r, and {Pjxi,Pjyi,0jzi,Pjai} are the associated amplitudes which 
are time functions. Then kinetic and potential energy expressions in Equa- 
tions 3.6 and 3.7 could be integrated for all modes shape, and system dynam- 
ics are defined by a set of generalized coordinates composed by nominal joint 
parameters and modal amplitudes. Several often used mode shapes are sug- 
gested by [Meirovitch, 1980] for the general continuous beam. For example, 
polynomial mode shapes with orthogonal nature are used by [Graves, 1988]. 
Of course, selection of mode shape needs to meet geometric boundary condi- 
tions. Since a compliant link is generally modeled as a fixed-free or pinned-free 
beam, selected mode shapes must satisfy both boundary constraints. Usually 
simple mode shapes are employed to facilitate integration. Once the mode 
shapes are defined, the modal amplitudes could be reconstructed from on-line 
measurements as reported by [Hastings and Book, 1986]. 

For an n^-link robot, the total system kinetic and potential energy 

are 


N 

ICE = Y, KE J 

j = 1 

N 

PE = 'YPEj (3.11) 

j=i 

Here, payload is treated as a fixed link, and N is the total number of links 
including payload. By collecting all state variables into a vector q and defining 
that 


q = [0 T P T ] T 

0 = [01 ■■■0 ne ] T 

ft — [/^10 Phi ' ' ' /^1 ini /^lyl ' ‘ ' Plyny 


(3.12) 

T 


fllzl * * * filznz fiiai * * * f3\o( ncr ’ * \ 
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where 8 is the vector of all nominal joint variables, and ft is the collection of 
all joint and link vibratory amplitudes. Then the Lagrange equation gives 

' (3.13) 


d ONE _ OK E OPE = f v, c U e 8 

It ' Oqi Oq , Oq , \ 0 q, <E ft 


where </, is the ith element of the vector q defined in Equation 3.12, and 
e, is the generalized actuator force at the ith joint. In the above dynamic 
equations, it is assumed that no external force is applied on the system. 
Now, some remarks regarding the above derivation are given heic. In Figun 
3.1, the (j + l)th link is connected to the end of the deformed jth link, so 
coordinate transformation of the (j + l)th frame should be with respect to the 
distal end frame {.r instead of to the rigid link frame. Since change 
of {.?•', !/',£' } orientations are due to link twistings n t ,a y ,a t at r = L, so 

T; = [x'y'f'] = l rjPJj’ZjWW') 

- TjlVj(L) ( 3 - 14 ) 

where WAL) is a 3 x 3 transformation matrix needed to be defined. To find 
U j(L), the rotational matrices of a,., a y , a 2 at r — L are derived first. For 
small deformations, it can be shown that 


Rot(a-,a i .) 


1 0 0 
() cosa,(L) — sin a a -(L) 
0 sin a X {L) coso X {L) 


lief 


1 0 0 
0 1 0 
0 0 1 

1 + A x 


+ 


0 0 
0 0 
0 a r (L) 


“1 

■ 1 

0 

r 

o 


0 

1 

-«,(£) 


f 

o 


1 

0 

1 




-»r(L) 

0 


(3.15 


Rot(j/,o„) = 


cos a y {L) 

0 

sin n v (L) 


1 

0 

<v„(T) ' 

0 

1 

0 

r\ ^ 

0 

1 

0 

— sin oty(L) 

0 

COS Oiy(L) 


. -CVy(L) 

0 

1 


^ 1+ Ay 


(3.1C) 
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Rot(z,a*) = 


cos a z (L) -sina 2 (L) 0 
sina 2 (L) cos a 2 (L) 0 

0 ol 


1 

«.(£) 

0 


-a z (L) 0 

1 0 

0 1 


1 + A 2 


(3.17) 


where I is a 3 x 3 identity matrix. By neglecting the high order terms, a 
multiplication of the above rotational matrices produces 

(I + A x )(X + A y )(I + A*) « I + A* + A v + A* (3.18) 

Since the order of multiplication does not affect the above result, W, is given 

by 


Wj{L) = X -f A* + A y 4- A* = 


1 -oc t {L) Oty(L) 

cx z (L) 1 -0! i(l') 

1 


(3.19) 


_ -a y (L) a x (L) 

A substitution of the above W t into Equation 3.14 finishes the derivation of T'. 
Notice that the orthogonality property of the transformation matrix holds for 
T i.e., (T') _1 = Tf. After establishing local frame for each compliant link, 
the position vector of each local frame vertex could be generated recursively. 
The procedure of finding the local frame position of a compliant link is similar 
to that of rigid link except that the distal end-point deflections are added 
to each rigid link length. The jth link origin O, in Equation 3.2 could be 
computed by this procedure. Another comment is that the G and H function 
definitions are also applicable to compliant system dynamics. For example, 
in Figure 3.1, the velocities and accelerations of p' could be expressed by 



dP' OP' 


p> 

” 5<jfi dq 2 

■}q 


= p'4 


P' 

= tG P '(} + q T 

rHpiq 

U, 

= RG v iq 



= FiG p tq + q T 

RH p ,q 


( 3 . 20 ) 
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where link deflections and twistings and joint deformations arc considered in 
forming the G and H functions. With these compact notations, the kinetic 
energy formulation in Equation 3.6 could be expressed by 

2KE, = jp' T P'dm + j{JjT,(dI)T T w,} 

= » r (J tGJ rGfidm + f „Gl.T j (dI)Tf nG p ,)q (3.21) 

and the total kinetic energy is 

IKE = f £(/ tGJ rGpidtn + j R G$Tj{dI)TT R G„)q 

q T I“q (3,22) 

where /* is the generalized inertia matrix which is generally symmetric and 
positive definite. Another important result of assumed mode method is that 
resilient energy could be defined by constant stiffness matrices. For example, 
in Equation 3.7, the resilient energy of a y is given by 

\S Elt( w ?dr <3 - 23) 

since the assumed mode expression of 8 Z in Equation 3.10 could bo written 
as 

nz 

s z = £/WO<MO 

t=l 

= Plm.A’-) (3.24) 

with fihz and 4>j z defined by 

ft.W = MO-WOreK” 

4>,,(r) = feiW'" W'-feR*' (3 25) 



(3.26) 
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A substitution of the above a y into resilient energy expression in Equa- 


tion 3.23 produces 



5&I J EI ' C 


d 2 (t>jzs,d 2 <i> 




dr 2 /v dv 


1 

2 f 




(3.27) 


in which 


A” 


.?* 


= J E I,(^f)^Vdr^K 


nzXnz 


(3.28) 


is a constant stiffness matrix after integration. Similarly, the other resilient 
energy in Ecjvi&tion 3.7 could be defined by 

y E I,(?^-fdr = \dIK„P„ 

IjEA^fdr = 

i jGU^fdr = ( 3 - 29 > 

In the above equations, the vibratory amplitude vector and stiffness matrix 
dimensions are defined accordingly by the number of used assumed modes. 
With these constant stiffness matrices, it is possible to express the total po- 
tential energy in Equation 3.11 by 

PE = 't,(J p ,T v dr ) + \p Tk p (3 - 30) 


where 

K = diag(Aio Ai x Ii\ v Ai z Ai a A 20 A 2 * 4 * *] (3.31) 

and vector is defined in Equation 3.12. Let n p denote the total number of 
assumed modes, and n 6 be the number of nominal joints, then from Equa- 
tion 3.12, the dimensions of vectors 9 and /3 are given which are 8 € U ne and 
/? E Tl np . By the kinetic energy expression in Equation 3.22 and the potential 
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energy formulation in Equation 3.30, the system dynamics could be defined 

by 


d dKE dKE dRE 
dt dq dq dq 


n+ 


/[ 

f‘2 


+ 


0 

K0 


V 

0 


(3.32) 


where v 6 7 v n ® is the vector of generalized actuator forces, and f[ and / 2 are 
the coupling force terms defined by 


/; 

h 


(3 ' 33 ' 


both /( and / 2 are nonlinear functions of 6 , 0, ft, and /?, and their dimensions 
arc: f[ 6 R n ° and f < € 'JV' 1 * . For a simple system, a symbolic program like 
MACSYMA is generally suggested to perform analytical integrations of the 
above kinetic and potential energy expressions. 


3.2 Lumped Parameter Model of Compliant Manipu- 
lators 

Theoretically link deflections arc compost'd of infinite modes, but 

% 

resilient energy actually concentrates in few primary modes. Also, due to the 
damping effect and the demand of large energy to bend a link into high order 
mode shapes, high frequency modes are seldom excited in regular operation. 
Based on these facts, usually only primary modes are considered in the study 
of continuous link vibration. Furthermore, as the rigidity of a compliant 
link increases, the link deflection reduces and the number of dominant modes 
decreases. Therefore for small deflection, a simple but efficient method of 
studying link deformation is to focus on the largest contributor: the first 
mode. This first mode approximation method is called the lumped parameter 
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model. In the rigid body model, system inertia is modeled by a point mass. 
The same approach is extended to the lumped parameter model except that 
lumped springs are added to the compliant system to simulate structural 
deformation. These springs are imaginary and occupy no physical space or 
weight. They are defined by their locations, motion nature (translational or 
torsional), and stiffness values. In the lumped parameter model, each spring 
represents one degree of freedom, and a generalized coordinate is assigned to 
each vibratory displacement. It should be noticed that to preserve physical 
reality, the lumped spring stiffnesses are generally obtained experimentally 
such as reported by [Behi, 1985] and [Sklar, 1988]. 

Figure 3.3 sketches the lumped spring model of a compliant link. 
In that figure, the jth link is connected to its preceding link by a compliant 
revolute joint which is modeled by a torsional spring with vibratory amplitude 
Pj o. In case that the jtli joint is prismatic then joint compliance is replaced 
by a translational spring. The jth link is assumed rigid and the actual link 
compliances are undertaken by three translational and three torsional springs 
attached to the distal end of the link. The six springs arc assumed decoupled. 
The translational springs duplicate the end-point deflection of the link along 
each local coordinate direction whose amplitudes are given by 
The torsional springs produce the distal-end twistings of the link in three 
orthogonal directions which are defined by {/?*, fts, M- Therefore in the 
lumped parameter model, each link deformations could be defined by seven 

vibratory coordinates which are 

{fto, Pjl > Pi 3 ' Pi 4 ’ } 

and plus the actual joint displacement there are eight degrees of freedom 
to each compliant link. Hence, an relink compliant manipulator could be 
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modeled by 8 n e degrees of freedom in the lumped parameter model. 

Iu the lumped parameter method, the modeled springs are assumed 
decoupled, hence the pseudo-joint concept could be introduced to define the 
vibratory motion. In the pseudo-joint technique, a modeled spring is treated 
like an actuator of an imaginary joint, and the resultant deflection is dupli- 
cated by the movement of that imaginary joint. For example, a translational 
deflection is replaced by a pseudo prismatic joint, and a torsional deformation 
is modeled by a pseudo revolute joint. These pseudo joints are driven by the 
force or torque stored in the deformed springs. After replacing all springs 
by pseudo joints, a compliant manipulator kinematically behaves like a rigid 
manipulator, and the rigid model dynamics derived before could be extended 
directly to the lumped parameter system. 

As a demonstration, the lumped parameter model of the three-link 
arm shown in Figure 2.3 is given below. Figure 3.4 shows a breakdown of the 
three-link arm. Deformation of each link is approximated by the fundamental 
mode in each direction. For example, the first link motion is defined by the 
nominal joint displacement ft, joint deflection ft, three linear deflections 
{ft, ft, ft} at the distal end, and three end-point twistings {ft, ft, ft}- The 
vibratory directions of the above amplitudes are indicated in the figure. Iii 
this example case, there are eight degrees of freedom in each link, hence totally 
twenty-four generalized coordinates are used to define the arm motion. In 
order to describe the arm motion, the transformation matrices are computed 
first to define the local coordinate frames of the three-link arm, which are 


T\ 


[ft Vi ft] 

’ cos(ft + ft) 
sin(ft + ft) 
0 


- sin(ft -fi ft) 0 
cos(ft -I- ft) 0 
0 1 
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T 2 = [x 2 y 2 h] 

' 1 _/? 7 0 6 1 I" COS 90 0 sin 90 

= Tj 0 7 1 -0s 0 10 

-f 3 G 1 -sin 90 0 cos 90 

T 3 = [x 3 y 3 ^3l 

r i -ft* 0w l r i o o 

= T 2 014 1 -012 0 cos 90 -sin 90 

—0i3 0i2 1 0 sin 90 cos 90 

cos(0 3 + 0 15 ) — sin(0 3 + 0i5) 0 

sin(# 3 + 0i5) cos(0 3 + 0i5) 0 (3.34) 

0 0 1 . 

where small twisting angle assumption and Equation 3.19 results are applied 
in the above equations. As an example, the linear and angular velocities 
of the point p in Figure 3.4 are derived in terms of the G functions. The 
positional vector of p is given by 

P = Pu + P 23 + P 3 P € ft 3 (3.35) 

where P 12 is the positional vector from the origin of the first frame to that of 
the second frame, similar definition is used on P 23 , and P 3p is the positional 
vector of p with respect to the third frame. All vectors are defined in the 
fixed global frame {X 0 ,Y 0 ,Z 0 }. Details of the above positional vectors are 
shown in the following equations: 

P i2 = Xi + 0 2 Xi + 03$! + 04^1 

P 23 = 0 2 Z2 4- 08^2 4- 09 X" 2 4- 010 y 2 4- 011 ^2 

P, 3 p = Z 3 y 3 4- 016^3 4- 0i7y 3 4- 0 is2 3 (3.36) 

By the pseudo-joint technique, the arm is defined by the generalized coordi- 


nates 


Q = [$1 0 2 @3 01 02 02l] T G P 2 * 
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Now, each link of the arm is assumed rigid and is connected by decoupled 
actual and pseudo joints. This model allows us to define point p velocities by 
using G functions, which are 


P = rG p q 

$ = nG p q (3.37) 

where <j> is angular velocity of p, and the 3 x 24 matrices, iG p and rG p , are 
the translational and rotational G functions respectively whose elements are 


given as follows 


rG p — 


r dp dp 

[ dd x dd 2 


'-'y dp i 

^ ""dKi 


(3.38) 
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0 


(3.39) 


and 


/< 


G„ 


0 0 Or 1 y x iiO 0 0 0r a y 2 z 2 23 0 0 0.r 3 y 3 23 


(3.40) 


The above results are created by a direct application of the G function defi- 
nitions listed in Tables 2.1 and 2.2. Similarly, accelerations of p are 


P = rG p q + q T tH p q 

= rG p q + q T rH p q (3.41) 

where T H p and rH p G 7l 3x24x24 are the associated H functions. The above H 
functions could be derived immediately from Tables 2.3 and 2.4. However, due 
to the prohibitively large dimension, they are not shown in this report. The 
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above results are applicable to any point in the arm, so the lumped parameter 
model possesses the efficient nature of rigid body model. Therefore for an 770- 
link compliant manipulator modeled by the lumped parameter technique, the 
system kinetic energy is 

KE = I £,(m,q T t GJ t Gj q + q T K&jTjljTj B G,q) 

Z j=l 

" \fr(e,p)q (3.42) 


where 


r(BJ) = Bm, t GJ r Gj + rG]T 3 I 3 TJ r G } ) g n Sn °* 8n ° (3.43) 
j=i 

is the generalized inertia matrix which still maintains the symmetric and pos- 
itive definite character. In the above equations, q is a generalized coordinate 
vector composed by two parts: q = [<9 r ,/? 7 '] r , where 9 € Tl ne is the vector of 
all nominal joint variables, and /? G Tv”* 3 contains all pseudo joint displace- 
ments with np — 7no . Also, 77i j is mass of the jth link, I 3 is the associated 
moment of inertia, and N is the total number of links including payload. 
Following the above notations, the system potential energy is 

PE = '£ m,rjg + \p T KD (3.44) 

7=1 £ 

where K is a diagonal stiffness matrix whose diagonal values correspond to 
the modeled spring stiffnesses. The Lagrange equation is used directly to 
formulate the system dynamics which are 

d .OKE , dKE , dPE _( v, q, e 9 ( . 

di ( -dT ) ~ ~W + ~W ~ l o ?. e p (3 45) 


Then by using the approach introduced in Chapter 2 and the lumped parame- 
ter model approximation, the dynamic equations of a compliant manipulator 
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art: given by 
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(3.4C) 


where f[ G 7v ne and f 2 G 7v n/3 contain the summation terms in the above 
equations, and both are nonlinear functions of 0, <9, /?, and /?. In the above 
equation, v is an n$ vector of generalized actuator forces. 

3.3 Compliant Manipulator Dynamics Including Actu- 
ator Parameters 

In both distributed and lumped parameter models, the compliant 
manipulator dynamics have the common symbolic form of 


r<i + 


.ti 


+ 


o 


v 

0 


(3.47) 


where q is the vector of generalized coordinates composed of nominal joint 
displacements 0 and vibratory deflections /?, /* represents system generalized 
inertia and is a function of 0 and /?, j[ and f 2 contain the nonlinear Coiiolis, 
centrifugal, and gravitational forces, Kfi is the vector of spring forces, and e is 
the vector of generalized actuator forces. To complete the system dynamics, 
actuator dynamics is added to the above dynamic equations in this section. 
First, since 6 G E - n ° , fi G and I* = I’ T , I * could be divided into following 
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r = 


a; e t 

E A 2 


g 7^("#+ n /j) x ( n «+ n />) (3.48) 

where A', G K neXn \ E G K H0Xne , and A 2 G R n0Xn0 . Then Equation 3.47 
becomes 

r a / vt iriji Tf/i r n 1 r ... 1 

(3.49) 
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where the first part, i.e., 


A \e + E T is + f[=v 


(3.50) 


represents the dynamic balance between actuating forces and system re- 
sponse, and the second part 

E0 + A + h + K/3 = 0 (3.51) 


shows the interaction between nominal and oscillatory motions through spring 
forces. It is assumed that the compliant manipulator is driven by DC servo 
motors, and the actuator dynamics of the jth joint DC motor are 

Ljij + Rj 1 j Nj8j = i ij (3.52) 

NjJjd, + NjDjdj + NjSjd, + Vj/N, = Ktjij (3.53) 

where ij is the armature current, Lj is the circuit inductance, R 3 is the 
circuit resistance, K v] is the actuator voltage gain, ti' is the voltage input, 

Jj is the armature inertia, D } is the actuator damping, Sj is the motor shaft 

stiffness, Ktj is the actuator torque gain, vj is the external load, and Nj 
is the gear reduction ratio. The subscript j indicates the parameter of the 
jth joint actuator. These actuator parameters except Vj are constant values. 
Generally, the inductance Lj is negligible, so Equations 3.52 and 3.53 could 
be combined into a second order form 
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Then for an n#-link manipulator, the actuator dynamics can be grouped into 


JO + DO + K c 0 + v = Kiu 


(3.55) 


when 


J = diag[( N?J l )(NlJ 2 )--(NlJ n9 )} 


D = dmg[(Ny D\ + 


KiK v lKt\-^ ( \j2 r» i ^no^vTigKtnQ 


■)■■■ (K D„, + 


R\ 7 \ m ne n B 

K c = diag [(N*S t )(NlS 2 )---(NlS ne )) 
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ne 


Kt = diug[( 


KtlN, wA|2^2^ , Ktne^ne 

~nT n ~RT ) 1 


)] 


(3.56) 


and J, X), /v c , and K t arc 7i# x n# constant diagonal matrices. Also, u* is 
the vector of input voltages with u' as the j th element. By substituting 
Equation 3.50 into Equation 3.55, the combined dynamic equations become 


(a; + j)o + z T ii + /; + do + k c o = av 


(3.57) 


tlie above ('equations have actuator voltages as the control inputs. By defining 


Ax = A', + J ; h = /,' + DO + K e 0 ; u = AV 


(3.58) 


the final system dynamic equations are 


A, TJ 
E A 2 



/. 

/ 2 + Kfi 


u 

0 


(3.59) 


In the later controller designs, control algorithm will Ik* built based on the 
above symbolic dynamic equations which are general for distributed and 
lumped parameter models. The designed input it will be divided by A t to 
obtain the actual input voltage vector u'. 
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3.4 Comparison Between Distributed and Lumped Pa- 
rameter Models 

In the previous sections, we have presented the model and dynamic 
equations for compliant manipulators by both distributed and lumped pa- 
rameter methods. By comparing the assumption and techniques used in both 
approaches, each one possesses its unique characters that are not shared by 
the other. Obviously, the advantage of distributed parameter model is its 
precision. Since the distributed parameter model defines vibratory motion 
based on the dynamic balance of each differential segment along a compli- 
ant link. Fidelity is the strong point of this method. The disadvantage 
of the distributed parameter model is computational inefficiency. Although 
the resilient energy of a continuous link is contained primarily in few basic 
modes, and finite number of assumed modes are often applied to simplify the 
dimensions and integrations of a given distributed model, the final system 
dimensions are still beyond the real-time computation capacity of general 
processors. Therefore, the distributed parameter model is used mainly in 
off-line design study. 

By contrast, the lumped parameter technique models link deflec- 
tions by the first mode approximation and neglects high order mode effects, 
so exactness is not the focus of this method. But due to its smaller dimension, 
the lumped parameter method is a candidate for real-time control model. Of 
course, selection of a compliant manipulator model still relies on the nature of 
a given compliant manipulator and conditions of application. Several factois 
affecting selection of model are listed as follows: (1) dimension of compliant 
link, (2) material of compliant link, (3) robot operation speed, (4) payload 
size and external force, and (5) operation precision requirement. The first 
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two factors define link rigidity, the third and fourth factors determine the 
load supported by the link, and the last factor decides the degree of accu- 
racy needed in a compliant link model. For example, according to [Ussher 
and Doetsch, 1983] and [Taylor, 1985], Space Shuttle Remote Manipulator 
System (RMS) has two tubular booms (links) of diameter 13.5 in and length 
23 ft and 20.9 ft separately, and the booms arc made from graphite-epoxy 
composites. Due to the lightweight nature, the stiffness of RMS at its fully 
extended position is 7.5 lb/in, plus the maximum payload mass is 65,000 lb, 
apparently high order mode effects are important in analyzing link deforma- 
tion. However, RMS operates in a zero-g environment, so the inertial load is 
caused mainly by the motion of the payload. Therefore, when RMS operates 
in a low speed, the inertial load is very small in which case the first mode 
dominates link deflection, then the lumped parameter model is considered an 
efficient approach. Additionally, RMS is so light that its inertia is almost neg- 
ligible in comparison with payload and Orbiter inertia. Hence, [Book, 1979] 
and [Sellhorst, 1982] treat RMS as massless chain and model its compliances 
by lumped springs. This example points out that selection of compliant ma- 
nipulator model is basically oriented by a given task. The tradeoff between 
accuracy and computation effort should be decided by user based on the fi 
nal purpose of application. Currently, the distributed parameter model is 
used in off-line design or on-line motion control of simple structures like one- 
link arms, e.g., [Hasting and Book, 19S6], and the lumped parameters model 
is used in on-line control study of high degree-of-freedom robotic manipula- 
tors as reported by [Hernandez, 1989] and [Lin, Tosunoglu, and Tesar, 1990, 
b]. 



Chapter 4 


Dynamic Property Investigation of Compliant 

Manipulators 


In the last chapter, we derived compliant manipulator dynamic 
equations by both distributed and lumped parameter models. Unlike rigid 
body dynamics, compliant dynamics have additional np equations describing 
the vibratory system behavior. These additional equations carry some piop- 
erties that are distinct from rigid body dynamics. Four major aspects of these 
properties are investigated here: reduction to rigid system dynamics, the sys- 
tem natural frequency, accessibility of vibratory mode, and controllability of 

vibratory mode. 


4.1 Reduction to Rigid System Dynamics 


The compliant manipulator system dynamics are derived in Equa- 
tion 3.59 which are common for both distributed and lumped parameter mod- 
els. This section will study the physical meaning of vibratory dynamics when 
the structure becomes infinitely rigid. First the dynamic equations in Equa- 


tion 3.59 are repeated here, which are 


\ A, E T ' 

' 9 ' 
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Si 
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s a 2 

J . 
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h + Kfi 


0 


e n ne+n 0 


( 4 . 1 ) 


where the upper part represents the dynamic equations of nominal joints, 
and the lower part describes the vibratory mode dynamics. When mampula- 
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tor rigidity increases and structural deflection becomes negligible, the vibra- 
tory amplitudes vanish from the dynamic expressions, and the upper part of 
Equation 4.1 reduces to the rigid body dynamic expression. Consequently, 
the vibratory dynamics which occupy the lower part of Equation 4.1 take 
on a different physical meaning. Recalling that in deriving the rigid body 
dynamics in the second chapter, we have used the Newton-Euler approach to 
show that the dynamic equation at each joint is actually the projection of all 
inertial loads on that particular joint, and that the actuator force is the coun- 
teracting force to the projected inertial load. Following that relation, the final 
system dynamic equations balance joint actuating forces to system inertial 
load. However, in doing so, it is assumed that each link is of infinite strength 
to support and transmit these forces, therefore, structural internal reaction 
forces are neglected because they are cancelled out in the final dynamic ex- 
pressions. In a rigid link system, the spring force Kfi is exactly the internal 
reaction force that is generally neglected in rigid body dynamics. This result 
could be explained from pseudo-joint point of view. In a lumped parameter 
model, each link has six decoupled pseudo joints located at the distal end: 
three orthogonal prismatic joints and three orthogonal revolute joints. Then 
the lower part of Equation 4.1 indicates that A' /? is the force counteracting 
inertial projection at each pseudo joint, or direction, hence when link rigidity 
becomes infinitely large, K/3 becomes the internal reaction force or torque at 
the distal end of a given link. Therefore, in the rigid link case Ad represents 
internal structural forces, and the lower part of Equation 4.1 represents the 
action and reaction balance at each pseudo joint location and direction. It 
should be noted that although internal forces usually do not show up in the 
final system dynamics of a rigid body model, it is important to analyze these 
forces for structural strength design. 
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4.2 Structural Natural Frequency 

Another important information observed in the vibratory dynamic 
equations is the structural system natural frequencies. For a stationary ma- 
nipulator, the actual joints are motionless, that is, $ = 0 = 0. Then a sudden 
blow on the manipulator will cause structural oscillations. The oscillatory 
dynamic equations are exactly the lower part of Equation 4.1 with 0 = 0 = 0, 
that is, 

A 2/ 3 + / 2 (<? = 0) + A'/3 = 0 (4.2) 

The above equation is a simple second order system with A 2 as the generalized 
mass matrix, / 2 as nonlinear damping force vector, and K as the spring 
matrix. For small oscillations, / 2 is negligible according to [Belli, 1985], then 
Equation 4.2 is reduced to 

{3 + A^Kp = 0 ( 4 - 3 ) 

Let ft = A/3, then A is the eigenvalue of 

(AI — Aj'/v )/? = 0 (4-4) 

and P is the associated eigenvector. In the above equation, I is an n 0 k 
n p identity matrix. For a compliant manipulator modeled by n g vibratory 
modes, there are n p natural frequencies given by the square root of A. For 
each natural frequency, the associated eigenvector gives information on the 
relative magnitudes of modeled modal amplitudes. These natural frequencies 
and eigenvectors could assist users to identify system inertial and stiffness 
parameters. For example, [Belli, 1985] has experimentally measured Cincin- 
nati Milacron T3-776 robot oscillatory frequencies and vibratory modes and 
then used modal analysis methods to determine the inertial and stiffness 
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values. Of course, since A 2 is position dependent, the eigenvalues and eigen- 
vectors change with manipulator position. Therefore, a least-square curve 
fitting approach may be used to average the experimentally obtained system 

parameters. 

Another usage of the vibratory dynamic equations is to decide the 
quasi-static deflection of a compliant manipulator. A stationary manipulator 
is subjected to gravitational loads and hence deflection. Similarly, a work- 
ing manipulator deforms under dynamic inertial loads. An approximation of 
analyzing the structural deformation of a moving robot is by quasi-static ap- 
proach. In quasi-static analysis, robot is assumed stationary at every instance 
of motion, then the static deflection caused by the inertial and gravitational 
loads are computed for that position. This means that by neglecting the ft 
and 0 terms in Equation 4.1, the quasi-static deflection is given by 

ft = -A'-'(E0 + / 2 ) ( 4 ' 5 ) 

In the above equa tion, it is assumed that all ft terms m E and / 2 arc negligible, 
therefore, E = S(0) and / 2 = / 2 (M)- Since the quasi-static deflection is con- 
sidered to be the major contributor of structural deformation, it is suggested 
by many researchers to compensate quasi-static deflection by cither off-line 
trajectory planning or on-line control-in-the-small method as reported in the 
first chapter. Detailed analysis of quasi-static deflection and global stiffness 
matrix derivations are presented by [Fresonke, Hernandez, and Tesar, 1988], 
and real-time computation of manipulator quasi-static deformation is studied 

by [Hernandez, 1989]. 
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4.3 Accessibility of Vibratory Modes 


Another dynamic property to be examined is the effect of kinematics 
on vibratory mode motion control. In the dynamic equations 

(4.6) 


' A, E r ’ 

' 6 ' 

I 

fl 


u 

E A 2 

J. 

“t" 

. h + Kf> . 


0 


the generalized inertial matrix associated with acceleration term is positive 
definite therefore invertible. Then the inverse of the inertial matrix is defined 
as 


' Ai 

C T ' 

def 

‘ A t 

E r ' 

C 

A 2 


E 

A 2 


(4.7) 


(Ai - 2^y l ~ (A, - E T Aj 1 s)~ 1 E^Aj 1 

-AJ*E (Ai - E^s ) -1 Aj 1 + A 2 - j E (A x - E r A 2 1 e) _1 E 3 ^ 1 


where the second equation gives the inverse identity in terms of the subma- 
tiices of the original inertial matrix. In the above equations, the dimensions 
of each element are: Ai £ 1Z neXue , E £ JZ n ^ Xne , Aj £ 7Z n < ,Xn fi, £ 7£ n «, 
h € K n *, K £ K*f**f, 8 £ 7v n ®, and (3 £ TZ n «. Also, A, £ ft" 8 *" 8 , 
C £ ft"' 3 *" 8 , arid A 2 £ ft' 1 ' 3 *”' 3 . By these definitions, the dynamic equations 
could be written in a form 


' 8 ‘ 

+ 

‘ A, 

C T ■ 

fi 


A 1 

J . 

C 

A 2 

. h + Kfi 


C 


in which the column vectors of matrix [Aj C r \ T constitute the control space 
of a. Ultimately, these column vectors affect the control of u on [0 r ,fj r } r 
values. Although the second nonlinear term in the left-hand side of the above 
equation will alter acceleration response for a given input u, the following 
analysis focuses on the direct relation between input u and system accelera- 
tion response, especially (3, by investigating the properties of the gain matrix 
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[Af C T } T . Equation 4.8 could be rewritten as 


9 

a 




(/a + Kfi) 


(4.9) 


Since A\ is a diagonal submatrix of a positive definite matrix, it has full rank, 
hence 9 resides in the column space of A \ , and u can affect 9 directly. But C is 
an off-diagonal submatrix whose rank is indecisive, so u might not be able to 
affect some vibrational accelerations directly. One situation which we define 
as inaccessibility problem is that C contains one or more null row vectors. In 
that case, control u loses direct access to the corresponding vibratory mode, 
therefore, that particular mode is dominated by the nonlinear term f 2 + KP 
in the above equation. Notice that ft has the same gain matrix as u, so 
the inaccessible problem also occurs to ft. It will be shown later that this 
accessibility problem generally does not imply a controllability problem, but 
without the direct influence of control input u, active damping on structural 
oscillation is impeded. Also, since f 2 and hp arc nonlinear terms governing 
the inaccessible mode, they must have a specific structure to dampen that 
inaccessible vibration. Since f 2 is a nonlinear coupling term, constructing a 
specific f 2 by u is neither transparent nor an easy task. Additionally, h p 
represents structural resilient force, using this term to remove inaccessible 
oscillation will create unwanted deformations, which apparently is not an ef- 
fective strategy. So, inaccessibility becomes a control problem for compliant 
manipulators. Another important feature of vibrational accessibility is its 
kinematic dependence. Since the value of C varies with manipulator posture, 
a vibrational mode could change from being accessible to inaccessible as ma- 
nipulator changes its configuration. This kinematic dependency makes the 
study of inaccessibility of vibrational modes an important and valuable work 
in the control of compliant manipulators. 
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4.3.1 The Algebraic Interpretation of Vibratory Mode Accessibil- 
ity 

To investigate the occurrence of one or more null row vectors in C, 
the constituent elements of C are examined. From Equation 4.7, the inverse 
identity of C is expressed by 

c = -aj‘e(a, -e’aj'e)”' 

-(A,-'E) lr (A,-E’'A ! - 1 E) 

-(Aj‘E)„ (A,-E r Aj‘E) 

-(A,->E) njr (A.-S^AJ'E] 

where (A^E)*,. is the tth row vector of (A^E) with i E {1, •••,«/?} and 
(Aj'E)^ G 71"®. Notice that the second subscript r indicates a row vector, 
later on, another subscript c will be used to denote the column vector. Now, 
for example, if the j th row of C is a null vector, then 

(Aj l E ) ir (A, - E t A.J 1 E)~ 1 = 0 

which means that the j th row of C is zero when (Aj’E) jr is orthogonal to the 
matrix (A 1 - E r Aj l E)~\ Since (A, - E^j'e) 1 € 7 Z n ° Xn ° is an invertible 
matrix whose column vectors arc linearly independent and span 7Z no space, 
(Aj‘E)J r could be composed linearly by these column vectors. This implies 
that the orthogonality relation exists if and only if the j th row of (A 2 'E), 
i.e., (Aj'E)^, is a null vector. This could also be shown by postmultiplying 
(^Ai — E t AJ ! E) to both sides of Equation 4.10 which produces 

-A^E = C (Ai - S^-'S) 

C\r (Ai - E T AJ 1 E) 

C npr (Al - E T Aj J E) 





-1 - 
-1 

(4.10) 

-1 


(4.11) 
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where C ir is the *th row of C, then if the j th row of C is zero, so does the 
;th row of A^E. This result reduces the accessibility examination to the 
properties of (A^E). Defining 

D = (Aj*E) en n e* n ° 

= [D lc D ic ... D nec ] (4.12) 

where £>, c is the sth column of D } then 


E = A 2 D 


= [(A 2 D lc )(A 2 D 2c ) ... (A 2 D nec )] 

= . • . £,,,„] (4.13) 


where E ic is the ith column of E and E, c = A 2 D ic which could be further 
expressed as 

np 

— ]C ^ki(^i)kc (4.14) 

*=i 

where ( A 2 ) £ c is the kth column of A 2 , and D*, is the fctli row and ith column 
element of D. According to Equation 4.12, for the jth vibratory mode to be 
inaccessible, the jth row of D must be a null vector, which makes Dj{ zero 
for all i, therefore, 

np 

Eic = ^2 D ki{^i)kc (4.15) 

= 1 
Mi 

for all i e {1, • ’ • , n o}- Which means that when all columns of E are linearly 
independent of the jth column of A 2 , the j th vibratory mode is inaccessible. 
This could be verified from another approach. By defining 


a 2 - j e = 


' (A 2 _1 )irE ‘ 

. (A a -% r E . 


(4.16) 
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where (Aj 1 )^ is the ith row of A 2 \ so when the jth row of (A 2 X E) is a null 
vector, the jth row of Aj 1 must be orthogonal to E. But A 2 1 is invertible, its 
row vectors are not zero, therefore, it will be shown next that the orthogonal 
relation occurs only when all columns of E are linear independent of the jth 
column of A 2 . Since A 2 is an invertible n p x n p matrix, its column vectors 
arc linearly independent, and all vectors in 7 v n ^ space could be composed by 
A 2 column vectors. Therefore, following the notation used in Equation 4.14, 
the ith column of E could be expressed by a linear combination of A 2 column 


vectors as 


(E) <c = f>fc.(A 2 )*c 


jt=i 


(4.17) 


where D ki is a scalar coefficient. Also, since A 2 1 A 2 = X where X is an n p x n p 
identity matrix, which implies that (A 2 )J r 1 (A 2 )jt c = Sjk with = 1 at j = k 
and zero if j ^ Jt, then for the jth vibrational mode in Equation 4.16 to be 
inaccessible, the following relation exits for all t, i.e., 

(A 2 1 )jr(E)<c ~ E 1 )jr(A 2 )fcc 

Jfc=l 

= d 3X 


= 0 


(4.18) 


Together with Equation 4.17, the above result shows that when every column 
of E is linearly independent of the jth column of A 2 , the jth row of C is a null 
vector and the jth vibratory mode is inaccessible. Which supports the result 
derived in Equation 4.15. Although the above analysis concentrates on one 
inaccessible vibratory mode, similar conclusion could be extended diiectly 
to the case of multi-inaccessible vibratory modes, which can be stated as: 
when all columns ofT, are linearly independent of some particular columns of 
A 2 , the corresponding vibratory mode accelerations are inaccessible to control 


input u , 



so 


4.3.2 The Physical Interpretation of Vibratory Mode Accessibility 

The above analytic results answer accessibility problem from alge- 
braic point of view. Additional physical interpretation can be obtained from 
the roles of E and A 2 in the compliant system dynamic equations. According 
to Equation 4.6, the dynamics associated with vibratory modes are expressed 

b y 

E0 + A 2 /3 + fz 4- A fi = 0 (4.19) 

where E 9 and A 2 /3 are the inertial forces applied on the modeled vibratory 
coordinates and could be written in terms of column vectors as 

ne 

£9 = Z(£).A 
1=1 
U 0 

A a£ = £(A 2 ), c A (4.20) 

t=l 

where 8, and A, are the tth element of the corresponding acceleration vectors. 
Then the physical meanings of these column vectors could be interpreted 
as follows. For a unit <9,, the column vector (E), c represents the associated 
inertial forces on all vibratory modes, and (A 2 ) IC is a vector of similar iner- 
tial forces contributed by a unit According to the inaccessibility analysis 
and Equation 4.19, it could be concluded that when all 6 inertial forces on 
all vibratory modes are linearly independent of a partietdar vibratory accel- 
eration force on all vibratory modes then that specific vibratory acceleration 
is inaccessible to u. Interestingly, premultiplying Equation 4.19 by Aj 1 , we 
obtain 

P = -A^Efl - A 2 _, (/2 + K0) (4.21) 

If0 is considered as control input to the above equation, then any vibratory 
acceleration inaccessible to u will also be inaccessible to 8 and vice versa. 
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In order to have a better understanding on the above interpreta- 
tion of vibratory mode inaccessibility, a simple lumped parameter example 
is given for illustration purposes. The example, as shown in Figure 4.1 (a) 
and (b), is a two-link arm modeled with two lumped vibratory modes. For 
simplicity both links are assumed massless, only the payload has a mass m 
and moment of inertia I with I = diag[/„ /„/,]. In this example, the first 
link is considered rigid but the second link is compliant and modeled by two 
vibratory modes, in which the first vibratory mode, denoted by ft, represents 
end-point transverse deflection, and the second vibratory mode, denoted by 
ft, depicts axial torsional deformation. As shown in Figure 4.1, these vi- 
bratory modes are orthogonal to each other, and the translational mode ft 
is parallel to second joint axis, i.e., Z 2 , and the twisting mode ft is along 
the Aft direction. Let ft be the first joint parameter and ft be the second 
joint displacement measured from horizontal position. Then the generalized 
inertial matrix for this example is 

T (mil + I v - h) cos 2 ft + I x 0 -m/ 2 cos ft I x sin ft ' 

0 ml 2 + I Z 0 0 

I ~ —mli cos ft 0 M 0 

I x sin ft 0 0 Ix 

L (4.22) 


In Figure 4.1(a), the second link is positioned at ft = 0 where 


E = 


—mli 0 
0 0 


; a 2 


M 0 

0 I x 


(4.23) 


In the above equation, both columns of E are linearly independent of the 
second column of A 2 , therefore, according to the analytical interpretation, ft 
(but not ft) is inaccessible. It will be shown that the inaccessibility is due to 
geometric orthogonality. Since ft rotates about Z 2 which is normal to both 
ft an d ft vibrations, the second joint input can not access both modes in 




any configuration. This result could be verified from Equation 4.22 directly 
where the third and fourth row elements of the second column are always 
zero. Hence, the accessibility analysis concentrates on the first joint effect. 
When 0 2 = 0, fa creates an inertial force on the payload along Z 2 which is 
parallel to fa direction, then according to Equation 4.21, fa will be accessible. 
However, the torque on payload due to fa is along the Y 2 direction which is 
normal to the fa oscillation, hence fa is inaccessible at this position. 


In Figure 4.1(b), the second link moves to 0 2 = 90 deg, and 


E = 


0 0 
i x 0 


a 2 = 


M 0 
0 I x 


(4.24) 


which shows that both columns in E are independent of the first column of A 2 , 
therefore, fa (but not fa) becomes inaccessible in this position. Physically, 
0i and fa spin about the same axis at this position. Hence, the first joint 
can access the twisting mode. But 0, motion is normal to the fa lateral 
deflection, hence both joint inputs can not access fa. Through the simple two- 
link example, we introduce the physical meaning of inaccessibility problem 
and also address its dependency on system kinematics. Notice that in this 
example, the inertial force and torque on both pseudo joints arc contributed 
only by the payload, so the assumption of massless links does not oversimplify 

the results. 


The next example is to investigate the inaccessible positions of a dis- 
tributed parameter model. Now, the second link of the two-link arm in Figure 
4.2 is flexible and modeled as a continuous beam whose lateral deflection is 
described by two assumed modes with polynomial mode shapes 
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in which r is a distance variable along link 2 which has a length Z, 2 , and </q 
and <f > 2 are orthogonal such that Jq <f>i<f> 2 (ir = 0. In this example, only the 
lateral deflection along Z 2 is modeled, and it is assumed that rotatory inertial 
effect is negligible. So, for a uniform beam with mass m, mass moment of 
inertia / 2 = diag[/ r2 I y2 J, 2 ]> and a point-mass payload M, the 2 x 2 E and 
A 2 matrices are given by 

f + M -0.2 M 

—0.2 A/ + 0.02M 

Apparently, at cos d 2 = 0 both columns in E are linearly independent of any 

column of A 2 , hence both vibratory modes are inaccessible when 8 2 = ^^-tt 

for any integer n. This result is consistent with that of the lumped two-link 

example in Figure 4.1. Notice that the second column of the above E is 

always zero, which means that the second joint actuator can not access the 

lateral vibration all the time. Such a result is predicable from the geometric 

orthogonality between the second joint and the lateral vibration. Geometric 

orthogonality also causes inaccessibility of both assumed modes to the first 

joint, that is, when the second link is coaxial with the first joint, the moment 

arm between the first joint and the lateral deflection vanishes, therefore, the 

first joint contributes no motion to the lateral deflection and consequently 

loses access of the lateral deflection. 

4.3.3 The Structure of E and A 2 

Due to geometric orthogonality, both inaccessibility analyses in the 
above two-link examples have interesting kinematic interpretation. However, 
in a general compliant manipulator where multi-link compliances are encoun- 
tered, kinematic interpretation of the inaccessibility problem is not as trans- 
parent as in the two-link case. The following analysis will reveal the actual 


E = 


— !n ^ 1 cos # 2 — ML 2 cos 02 0 

— %fi?rL 2 cos 8 2 + O. 2 ML 2 cos 6 2 0 


; A 2 = 
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Figure 4.2: A Two-Link Arm with the Second Link Modeled by a 
Continuous Beam 


sc 


nature of E and A 2 from which kinematic complexity of the inaccessibility 
problem will be evidently clear. For a lumped parameter model, the inertial 
matrix could be expressed by the first order influence coefficient representa- 
tions as 


A, E r 
E A 2 


N 


— r. { m » rGj + rGJ I, flGij (4.25) 

t=i 

where tG, G TZ 3x i n » +n s) is the G function associated with translational mo- 
tion of link i, and /jG, 6 TZ 3x ( n » +n fi) is the G function associated with link i 
rotational motion. Also, J t € 7£ 3x3 is a generalized moment of inertia, defined 


as 

I, = TJ'Tf (4.26) 

in which T ) € 7v 3x3 is a transformation matrix converting the local coordinates 
defined in the tth frame to global coordinates, and /’ G 7v 3x3 is the moment 
of inertia of link i defined in the ith frame. The upper limit of summation, N , 
is the total number of links including payload. By dividing the G functions 
into two submat rices as 


l'Gi — [( tG,)o ( rG,)p] 

nGi - [( rG^o ( nG,)^] 


(4.27) 


where ( T G,) fl , ( rG,) 0 G 7v 3xn ® and ( rG^p, ( rG { )p G TZ 3xn ^ , then Equa- 
tion 4.25 could be expanded into 


Ax E T 
E A 2 


_ y' f [ ( rGi)J{ rG^e ( tG^K tG { ) p 
•hi ’ [ tG^I tG-)6 ( tGJ^I tG-)p 


+ 


(4.28) 


( RGi)JIi( R G t ) e ( rGM R G,)p 
( R Gi) T pIi( R G-) e ( «G,)^/,( R G-)p j 

by comparing term by term, the submatrices E and A 2 have the following 
equivalent forms 

£ = { m *( tG,)%( rGi)e + ( fi G,)J/,( nG,) fl | 


i=i 


ci 


(4.29) 
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(4.30) 


(4.31) 


A 2 = £ |mj( rGi)^( rGi)p + ( rG^p] 

t=i 

Similarly, for distributed parameter model, 

E = L {/( rG r .)l( T G r .)edm + J ( K G f .)$(dI)( uG,.),) 

A, = £ {/( T<V)J( rGy)fidm + J ( nG r .)J(<l/)( «G p .) tf } (4T2i 

Details of both lumped and distributed parameter dynamics are given in 
Chapter 3. Although the kinematic interpretations of the above G functions 
are well-defined, they can not be extended to E and A, directly because 
the kinematic relations are coupled after the matrix multiplication. Desides 
that the mass and moment of inertia of all links are mixed in the E and A, 
expressions, that makes it difficult to obtain a simple geometric interpretation 
of the inaccessibility problem. So, before the kinematic effects of vibratory 
mode accessibility could be understood thoroughly, inaccessible modes can 
only be identified from E and A, analytically. Since it is highly demanding 
to check the dependency of each column of S and As, a practical approach is 
to compute A,-‘E symbolically to examine the occurrence of row or rows of 

zero vectors. 


4.3.4 Case Studies of Inaccessible Vibratory Modes 

To further examine robot position effects on vibratory mode acces- 
sibility, a three-link manipulator is modeled increasingly with one, two, four, 
and eight lumped vibratory modes. In each case, the inaccessible nominal 
position is computed symbolically for each vibratory mode. The purpose of 
using increasing number of vibratory modes is to check whether consistent in- 
accessible positions would be obtained as the modeled vibrations on a given 
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(Note: local coordinate frame is 
shifted to the distal end of each linK 
to indicate vibratory mode directions) 


Figure 4.3: A 3-Link Arm Modeled with 8 Lumped Compliances 
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system are varied. Figure 4.3 is the three-link manipulator with all eight 
lumped vibratory modes. Each vibratory mode depicts a link deflection in a 
particular direction. Notice that each local frame is shifted to the distal end 
of the link to assist description of vibratory mode directions. For example, 
is the first link lateral deflection along the Xj direction, /? 4 is the second link 
lateral deformation along the t y 2 direction, and /?« is the third link twisting 
along the x 3 direction, and so forth. These local coordinates will be helpful in 
presenting the investigation results. For example, when four modes, /?i, An 
/? 3 , and /?5 are modeled, they will be denoted as x x y x x 2 z 2 for compact indi- 
cation of which link and direction of vibrations are involved in the study. In 
these eight vibratory modes, ft (|to) and ft (y 3 ) are always accessible because 
kinematically $ 2 can affect ft directly, so does $ 3 to ft. Therefore, they are 
excluded from the following report. The other six inaccessible mode results 
are tabulated in Tables 4.1 (a) to (f), and in each table, the inaccessible mode, 
the modeled vibratory modes, and the inaccessible position are listed. 


Table 4.1 (a) ft (*i) mode 


modeled vibrational inodes 

inaccessible position (deg) 


X\ 

$ 2 = 0 or 180 and 8 3 = 0 or 180 


a: 1 2/i 

0 2 = 0 or 180 and 8 3 = 0 or 180 


X X IJ\X 2 Z 2 

0 2 = 0 or 180 and 8 3 — 0 or 180 


x x yix 2 z 2 x 3 z 3 

$ 2 — 0 or 180 and 6 3 — 0 or 180 


x x y x x 2 y 2 z 2 x 3 y 3 z 3 

$ 2 = 0 or 180 and $ 3 = 0 or 180 


1 Table 4.1 (b) ft (y x ) mode 

3 

modeled vibrational modes 

inaccessible position (deg) 

V\ 

$ 2 = 90 or 270 and $ 3 = 0 or 180 

xiyi 

$ 2 = 90 or 270 and $ 3 = 0 or ISO 

x\y x x 2 z 2 

$ 2 = 90 or 270 

x x y x x 2 z 2 x 3 z 3 

$ 2 = 90 or 270 

x\y\x 2 y 2 z 2 x 3 y 3 z 3 

$2 = 90 or 270 

J 


90 


Table 4.1 

(c) /? 3 (.t 2 ) mode 


modeled vibrational modes 

inaccessible position (deg) 

x 2 

#2 = 0 or 180 and 0 3 = 0 or 180 

X 2 Z 2 

02 = 0 or 180 and 

(0 3 = 0 or 180 or 63 = 90 or 270) 


%\V\X 2 z 2 

02 = 0 or 180 and 

(0 3 = 0 or 180 or 0 3 = 90 or 270) 

X\V\X 2 Z 2 X3Z3 

0 2 = 0 or 180 and 

(0 3 = 0 or 180 or 0 3 = 90 or 270) 

xiyiX 2 y 2 z 2 x 3 y 3 Z3 

02 = 0 or 180 and 

(0 3 = 0 or ISO or 0 3 = 90 or 270) 

Table 4.1 ( 

'd) /? 5 (z 2 ) mode 

modeled vibrational modes 

inaccessible position (deg) 

*2 

0 2 = 90 or 270 and 0 3 = 0 or 180 

X 2 Z 2 

02 = 90 or 270 and 0 3 = 0 or 180 

X \])\ X 2 Z 2 

0 2 = 90 or 270 

x\y\x 2 z 2 x 3 z 3 

0 2 = 90 or 270 

XiyiX 2 y 2 Z 2 X 3 V 3 Z 3 

0 2 = 90 or 270 

Table 4.1 (e) /?e (.r 3 ) mode 

modeled vibrational modes 

inaccessible position (deg) 

$3 

(0 2 = 90 or 270 and 0 3 = 90 or 270) or 
(0 2 = 0 or 180 and 0 3 = 0 or 180) 

*3*3 

(0 2 = 90 or 270 and 0 3 = 90 or 270) or 
(0 2 = 0 or 180 and 0 3 = 0 or 180) 

X \V\X 2 Z 2 X 3 Z 3 

*0 

II 

O 

O 

0 

to 

-I 

O 

O 

II 

O 

O 

i— ‘ 

OO 

xiyix 2 y 2 z 2 X3y 3 Z3 

0 2 = 90 or 270 or 0 3 = 0 or 180 

Table 4.1 (f) /? 8 (z 3 ) mode 


modeled vibrational modes 

inaccessible position (deg) 

23 

02 = 90 or 270 and 0 3 = 0 or 180 

* 3*3 

62 = 90 or 270 and $3 = 0 or 180 

x i y 1 x 2 z 2 x 3 z 3 

0 2 = 90 or 270 or 0 3 = 90 or 270 

x\yix 2 y 2 z 2 X3y 3 Z3 

02 = 90 or 270 or 0 3 = 90 or 270 


For example, in Table 4.1 (b), when 3'ij/i vibratory modes arc modeled, 
^ 2 ( 1 / 1 ) is inaccessible at 0 2 = 90 or 270 deg and 0 3 = 0 or 180 deg, and 
in the Xiyix 2 z 2 x 3 Z 3 case, the inaccessible position of f3 2 (yi) mode is at d 2 = 
90 or 270 deg regardless 63 value. Notice that both results are consistent, 
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because 0 2 = 90 or 270 deg and 0 2 = 0 and 180 deg is a special case covered 
by the general outcome that /? 2 (j/i) is inaccessible when 8 2 = 90 or 2<0 deg. 
Similar tendency could also be observed from the above tables that when 
larger number of vibrational modes are modeled the results are much com- 
plete and general. Details of A^E symbolic results are listed in Table 4.2. 
Since A 2 is an invertible matrix whose determinant is not zero and has no 
effect on the final results, Table 4.2 is generated by the product of the adjoint 
of A 2 and E. Since the example is a three-link manipulator, each row vector 
of Aj J E contains three elements. In Table 4.2, the three row- vector elements 
associated with each vibratory mode are denoted sequentially by [1], [2], and 
[3] for the first, second, and third elements. The symbols used in Table 4.2 
are described below. m,- is the mass of link i with i — 1,2,3, and payload 
with i = 4, also l t is the link length, r, is the center of mass location along link 
t, and /, = ding[/ cl -, / yi , hi] is the moment of inertial. Interestingly, in the 
results some particular row elements arc always zero despite the manipulator 
configuration, which means that the corresponding actuator inputs can not 
access that vibratory mode in any robot position. In the symbolic results, the 
common sinusoidal terms arc highlighted, and once they take on a value of 
zero, that vibratory mode has a null row vector and becomes inaccessible. In 
the case studies, we examine the inaccessible position of a lumped parameter 
model. Now, one interesting question is that could lumped parameter results 
be extended directly to distributed parameter model? This means that if the 
first mode is inaccessible then docs that imply inaccessibility of higher order 
modes? Although such implications are observed from the two-link examples 
in Figures 4.1 and 4.2, yet, due to complexity of E and A 2 , we could not answer 
the question analytically. However, since the first mode dominates structural 
deflection, its inaccessibility should be identified and avoided. Therefore, we 
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emphasize the first mode instead of other higher order modes inaccessibility 
in the three-link arm case studies. But it should be noticed that the algebraic 
and physical interpretations of vibratory mode inaccessibility are built on a 
symbolic form general for both lumped and distributed parameter models. 

Notice that no joint compliance is modeled in the case studies be- 
cause in modeling a joint compliance the pseudo joint is added collinearly 
with the physical joint, hence both nominal and vibratory inertial torques 
projected on all vibratory coordinates are linearly dependent, therefore, joint 
vibration is always accessible and hence excluded from the study. The in- 
vestigation of inaccessible vibratory modes is important to off-line decision 
making on manipulator architecture and working position. It constitutes a 
criterion to help the user to choose a suitable manipulator for a given task. 
And for existent manipulators, finding out the inaccessible position will avoid 
manipulators from working in undesirable positions where structural vibra- 
tions can not be dampened actively. As mentioned before, inaccessibility 
problem is distinct from the controllability problem. Despite the fact that it 
is difficult to control an inaccessible vibratory mode, the controllability of an 
inaccessible mode will be discussed in the next section. 



93 


Table 4.2 

Xi of Xl 

[ 1 ] 

0 

[2] 

(-/ 3 m 4 - r 3 m 3 ) cos(0 2 )sin(0 3 ) + (-/ 3 m 4 - r 3 m 3 )sin(0 a ) cos(0 3 )+ 

(-/ 2 ro 4 — / 2 m 3 - r 2 m 2 )sin(0 a ) 

[ 3 ] 

(— / 3 m 4 - r 3 m 3 ) cos(0 2 )sin(0 3 ) + (-/ 3 m 4 - r 3 m 3 )sin(0 a ) cos(0 3 ) 

Xi Of XiJ/i 

[ 1 ] 

0 

[2] 

( — / 3 m 4 2 -|- ((-/ 3 - r 3 )m 3 - / 3 ?n 2 )m 4 - r 3 m 3 2 - r 3 m 2 m 3 ) cos(^ 2 )sin(^ 3 )+ 
(— Z 3 ?7 x 4 2 + (( — / 3 - r 3 )m 3 - / 3 m 2 )m 4 - ?- 3 m 3 2 - r 3 ?7i 2 m 3 )sin(0 a ) cos(0 3 ) 
+(-/ 2 m 4 2 + (( — / 2 - r 2 )?77 2 - 2 / 2 m 3 )m 4 - / 2 »n 3 2 + 

(— / 2 — ?’ 2 )m 2 77i 3 — r 2 m 2 2 )sin(0 a ) 

[ 3 ] 

(-hm.i 2 -f ((-/ 3 - 7' 3 )777 3 - / 3 rn 2 )m 4 - r 3 m 3 2 - r 3 m 2 m 3 ) cos(0 2 )sm(0 3 )+ 
( — / 3 777 4 2 + ((-/ 3 - 7’ 3 )?77 3 - / 3 m 2 )77i 4 - r 3 m 3 2 - r 3 m 2 m 3 )sin(0 a )eos(0 3 ) 
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Table 4.2 (continued) 
xi of x 1 y 1 x 2 z 2 
[ 1 ] 

0 

[2] 

(((-/ 3 2 + 2 r 3 / 3 2 - r 3 a / 3 )m 2 m. 3 + (-J y4 - / y3 + 4 4 + 4 3 )/ 3 Tn 2 )m 4 2 + 

((-?’ 3 / 3 2 + 2r 3 a / 3 - r 3 3 )m 2 m 3 2 4- ((-/ y4 - J y3 + I xi + 4 3 )4- 
r 3^i - 7 '3 4,3 + 7-344 + r 3 I x3 )m 2 m 3 )m 4 + 

(—r 3 I y .i — ? 3 / y3 -f- v 3 I x4 + r 3 I l3 )m2m 3 2 )cos(9 2 )sin'\0 3 )+ 

((((— 4 3 + 2r 3 / 3 2 — r 3 2 l 3 )m 2 m 3 4- (—4,4 — I y3 4- 4-4 + 4 3 )4777 2 )7774 2 4- 
((-r 3 l 3 2 + 2r 3 2 / 3 - r3 3 )m 2 m 3 2 + ((-/ y4 - J y3 + 4., + I x3 )l 3 - 
7 ’ 3 4-i ~ 7> 3 4/3 + v 3 I X 4 r 3 I x3 )m 2 m 3 )m.i 4- (—r 3 I y 4 — r 3 I y3 + r 3 I x4 -\- 
7-34 3 )m2m 3 2 )sin(0Jcos(6> 3 ) + (((-/ 2 4 2 + 2r 3 4/ 3 - r 3 2 f 2 >?i 2 m 3 4- 
(“4/44 7- 7 y3 / 2 + 44 / 2 4- I X 3h)m2)ni4 2 + 

((-44 2 + 2r 3 44 - ?' 3 2 / 2 )m 2 ?7i 3 2 4- 

(( 7 2^3 4“ 2? 2 ? 3/3 1 2 1 3 )?72 2 4" ( 2 Iy<\l 2 2/ y3 / 2 4" 24-1 4 4" 24 3 4 ) 7 77 2 )777 3 4" 

(~ r 2^y4 ~ 7*2 4/3 4" 7’ 2 44 4* 7 1 2 4 3 )7772 2 )777 4 4- 
(-Iyik ~ Iyll 2 4- 4-44 + T r3 / 2 ) 777 2 ?77 3 2 4- 
( 7"2 4/4 - 7- 2 / y3 4- r 2 / r4 + r 2 / x3 )777 2 2 777 3 )sin(^ 3 )sin 2 (0 3 )4- 

(( — 44 — 4’3 ) 7 77 2 7 / 7 4 2 4* ((— 4-i — 4s)4 — r 3 4-i — r 3 I x3 )m 2 m 3 m.\ + 

( 7* 3 4.4 - 7 , 3 4 3 )7»»2»'7 3 2 )<-Os(0 2 )sin(0 3 )4- 

((— 4-i — I x3 )l 3 v} 2 m 4 2 4- (( — 4-4 — 4a)4 — 7’ 3 / r 4 — r 3 I x3 )>n 2 in 3 m 4 -f 

( 7' 3 4'i - 7' 3 4 3 ) 777 2 773 3 2 )sin(e ;i )cos((9 3 ) 4- ((-I x4 l 2 - I x3 l 2 )m 2 7 n 4 2 

+ ((— 24|7 2 — 2/ x3 / 2 )?7i 2 7fi 3 4- (~ 7- 2 4-4 — 7 2 / r3 );7l 2 2 )77>4 + 

(~ 4^4 — I x3 l 2 )?7l 2 77l 3 2 +( — 7’ 2 / x 4 — 7’ 2 / r3 )77l 2 2 777 3 )sin(0 a ) 

[3] 

(((— 4 3 4- 2 r 3 / 3 2 — r 3 2 l 3 )m 2 m 3 4- (— 7 y4 — 4/3 4- 44 4- 4a)4»7i2 ) 777.i 2 4- 

((-'• 3 f 3 2 4- 2t - 3 2 / 3 - 7- 3 3 ) 77l 2 777 3 2 4- 

(( — 4 4 4/ 3 4" 4-4 4" 4 3 )/ 3 7’ 3 / y 4 7’ 3 / y3 4" 7*34-4 4" 

7*3 4 a) 777 2 777 3 ) 77 i 4 4- ( — r 3 / y 4 - r 3 / y3 4- 7 3 4 4 4- r 3 I x3 )m 2 m 3 2 ) cos(0 2 )sin 3 (0 3 ) 
4-((( — 4 3 4- 2?’ 3 / 3 2 — r 3 2 l 3 )w 2 m 3 4- ( — / y4 — / y3 4- 44 4- 4 3 )47n 2 )m 4 2 4- 
(( 7*3 / 3 2 4- 2r 3 2 / 3 — r 3 3 )m 2 m 3 2 4- (( — / y4 — 4/3 4“ 4-i 4- 4 3 )4~ 

T’ 3 7 y 4 - 7" 3 / y 3 4- 7*3 / x 4 4“ 7’343)771 2 777 3 ) 777 4 4- 

(~ 7’ 3 / y 4 — r 3 / y3 4- 7' 3 7 x 4 4- 7' 3 4 3 )777 2 77 l 3 2 )sill(0 a )cos(^ 3 )sin 2 (^ 3 ) + 

(( — 7 x4 — I x3 )l 3 m 2 m4 2 4- ((—44 — 4 3 )4 — r 3 44 — 7* 3 4 3 )m2772 3 m4 4- 

( — 7’ 3 7 X 4 — 7’ 3 4 3 )777 2 777 3 2 ) cos(^ 2 )sin(0 3 ) 4~ (( — 4 4 ~ 4 3 )4 t '« 2 777 4 2 4- 
((-44 - 7 x3 )/ 3 - i’ 3 I x4 - r 3 I x3 )m 2 m 3 m 4 + 

( 7* 3 / x 4 - r 3 4 3 )7772777 3 2 )sin(^ a )cos(^ 3 ) 
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Table 4.2 (continued) 

Xl of XXYXX2Z2X3Z3 

[ 1 ] 

0 

[ 2 ] 

((-44/5,4/3 - 44/5,3/3 + 4344 / 3 )^ 2 ^ 3 ^ 4 2 + 

(-r 3 I X 4 ly 4 - r 3 I x4 I y3 + r 3 I x3 I x4 )m 2 m 3 2 m 4 ) cos(0 2 )s\n 3 (9 3 )+ 

(((— 4444/3 — 44 / 5 / 3/3 + I x 3lx‘ih)m2'ni 3 m4 2 + 

(- 7 - 34 . 4 / 5 ,,, - 7 - 344 / 5,3 + 7-34 3 44)77i 2 77J3 2 77l4)sin(^ 3 )cOs(^3) + 
((-44/5,4/2 - 4.443/2 + I X 3 lx 4 h ) m 2 ” Wn 4 2 + 

(( — 4444/2 — 4443/2 + I x 3^x4^2) m 2 m 3 2 -\- 

(~r 2 I X 4 ly 4 - r 2 I x4 I y3 + r 2 4344)m2 2 777.3)7n4)sin(0 a ))sin 2 (0 3 )+ 

{-I X 2 l X 4 hrn 2 m 3 m JL 2 - r 3 I x3 I x4 m 2 m 3 2 m 4 ) cos(0 2 )sin(0 3 )+ 
(- 4344 / 3 »” 2 »>* 3 »» 4 2 - j - 34344^2^3 2 »»4)sin(^ 3 )cos(0 3 ) + 
((-4 3 44/27772fJ?3 2 - r 2 I x3 I x4 7n 2 2 m 3 )m 4 - I x3 I x4 l 2 in 2 rn 3 m 4 2 )sin($ 2 ) 

[3] 

((-44/5,4/3 - 44 /y 3/3 + 434-4/3)™2m37?74 2 + 

(-7-344/5,4 - r 3 44/5,3 + r 3 4 3 44)77727773 2 77l4)cos(02)sin 3 (^ 3 ) + 

(( ^ x 4 ^ y 4^3 4 4 /y 3 /,3 "I” -4 3 4 ’ 4 /.7 ) 777 2 77 X 3 7 77 4 “f - 

{-r 3 I X 4 l V 4 - r 3 I x4 Iy 3 +r 3 I x3 I x4 )m 2 m 3 2 m 4 )sin(0,)cos(6 3 )s\n 2 (6 3 )+ 
(-I x3 I x4 l 3 m 2 7n 3 m 4 2 - r 3 I x3 I x4 m 2 m 3 2 m 4 ) cos(0 2 )sin(0 3 )+ 
(-Ix 3 lx 4 hm 2 m 3 m 4 2 - r 3 I x3 I x4 m 2 m 3 2 m 4 )sin(9i) cos(0 3 ) 

.Tx of x l y,x 2 y 2 z 2 x 3 y 3 z 3 

[ 1 ] 

0 

[2] 

( 7 ' 2 I x 4 Iy 4 - r 2 I x 4 I y3 + 7 - 24344 )n 7 2 2 7773777 4 3 sin(fl 3 )sin 4 (d 3 )-(- 

({ — l ' 3 I x 4 Iy 4 — 7*3 4-1 /y 3 + 7 ' 3 I x 3 I x 4 ) 7 U 2 V 73 2 77l4 3 + 

(-7-344/5,4 - 7-34.4/5,3 + r 3 4 3 44)77727773 3 7774 2 )cos(02)sin 3 (^ 3 ) + 
((-r 2 I x4 I y4 - 7' 2 I x4 Iy 3 + r 2 I x3 I x4 )m 2 2 m 3 ^m 4 2 - 
r 2 I x3 I x4 m 2 2 m 3 m 4 3 )sh\(9 3 )sin 2 (9 3 )+ 

(—r 3 I x3 I x4 m 2 m 3 2 v 2 4 3 - r 3 I x3 I x4 rn 2 m 3 3 m 4 2 ) cos(9 2 )sh\(0 3 ) 
-r 2 I x3 I x4 m 2 2 m 3 2 m 4 2 s\\\(9,) 

[3] 

(( _r 3 44 / 5/4 - r 3 I x4 Iy 3 + r 3 I x3 I x4 )m 2 m 3 2 m 4 3 + 

{—r 3 I x4 I y4 - 7-344/5,3 + r 3 4 3 / x4 )m 2 m 3 3 m 4 2 ) cos(0 2 )sin 3 (0 3 ) 
+(-r 3 4 3 44m 2 7773 2 7774 3 - r 3 I x3 I x4 7n 2 7n 3 3 m 4 2 ) cos(6 2 )sm(9 3 ) 
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Table 4.2 (continued) 
yi of y x 
[ 1 ] 

(~hm 4 - r 3 m 3 ) sin(0 2 )sin(0 3 ) + (l 3 m 4 + ?v«3)cos(0 3 )cos(^ 3 ) 

-\-(h m A + ^2^3 + ?'2ni2)cos(0 a ) 

[ 2 ] 

0 

[ 3 ] 

0 

1/1 Of 3,’lJ/l 

[1] 

( — l 3 m 4 2 + (( — / 3 — r 3 )m 3 — l 3 m 2 )m 4 — r 3 m 3 2 — r 3 m 2 m 3 ) sin(0 2 )sin(0 3 )4- 
(hm * 2 + ((^3 + *’3)^3 + 13^2)^14 + »’ 3 ^ 3 2 + r 3 m 2 m 3 )cos(0 3 )cos(0 3 )-f- 
(l2m 4 2 + (2l 2 m 3 -f (l 2 + r 2 )m 2 )jri4 + I2I113 2 + (h + r 2 )m 2 m 3 -f r 2 m 2 2 )cos(6 3 ) 
[ 2 ] 

0 

[ 3 ] 

0 

!/i of x 1 y 1 x 2 2 2 
[1] 

^3 2 — 2/- 2 r 3 / 3 + r 2 r 3 2 )m 2 m 3 + (r 2 / y4 -f r 2 / y3 — r 2 / r4 — r 2 / a . 3 )m 2 ) ?n 4 2 + 
((?' 2 / 3 2 — 2r 2 r 3 l 3 -(- r 2 r 3 2 )m 2 m 3 2 -f ((7’ 2 / 3 2 — 2r 2 r 3 l 3 -f J- 2 7' 3 2 )?n 2 2 + 

(2 r 2 / y4 + 2 r 2 / y3 — 27- 2 / x4 — 2r 2 / l3 )?n 2 )m 3 + 

(»’ 2 -fyl + >’ 2^3 ~ V 2 I x4 - V 2 I x3 )m 2 2 )m 4 + 

( r 2-fy4 + ?’2-fy3 ~ r 2^*4 — r 2-Tr3)>^2^3 2 + (?’2-fy4 + f'2-fy3 ~ 7' 2 / x4 — l' 2 I x3 )m 2 2 m 3 ) 

cos(0 3 ) sin 2 (0 3 ) -f ((?’ 2 J x4 + r 2 I x3 )m 2 m 4 2 + ((2r 2 / x4 + 2 r 2 / x3 ) 7 n 2 7 u 3 -(- 
( r 2-Tr4 4- i' 2 I x3 )m 2 2 )m 4 4 - (7' 2 / r4 4- 7 , 2 / l3 )?n 2 77i 3 3 4- 
( r 2-Tr4 + C 2 / x 3 )?n 2 2 77? 3 )cOs(0 3 ) 

[ 2 ] 

0 

[ 3 ] 

0 
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Table 4.2 (continued) 
yi of x 1 yix 2 z 2 x 3 Z 3 
[ 1 ] 

((r 2 I x4 I y 4 + r 2 I x 4 Iy 3 - r 2 I x3 I x4 )m 2 m 3 m 4 2 + 

((r 2 I x 4 Iy 4 + r 2 I x4 I y3 - r 2 I x3 I x4 )m 2 m 3 2 + 

{r 2 I x4 I y4 + r 2 I x4 I y 3 - r 2 I x3 I x4 )m 2 2 m 3 )m 4 )cos(0,)sm 2 (6 3 )+ 
ir 2 I x3 I x4 m 2 m 3 m 4 2 + (r 2 I x3 I x4 m 2 m 3 2 + r 2 I x3 I x4 m 2 2 m 3 )m 4 )cos(0 3 ) 
[ 2 ] 

0 

[3] 

0 

2/i of x\y\x 2 y 2 z 2 x 3 y 3 z 3 

[ 1 ] 

{.r 2 I x4 I y4 + r 2 I x4 I v 3 - r 2 / l3 / X 4)m 2 2 ?7i3??i4 3 cos(tf 3 )sm (0 3 )+ 
{{{r’lhJv* + r 2hJ y 3 ~ r 2 I x3 I x4 )m 2 m 3 2 m 4 3 + 

(r 2 lx 4 I y4 + r 2 I x4 I y3 - 7- 2 / l3 /r4)m 2 771 3 3 77l4 2 )cOS 3 (^ 3 )4- 
{r 2 I x3 I x4 m 2 2 m 3 m 4 3 + (r 2 / x4 / y4 + r 2 I x4 I v3 — r 2 I x3 I x4 ) 

777 2 2 U^3 2 7774 2 )C0S(^ 3 ) sin 2 (# 3 )-f 

(r 2 I x3 I x4 m 2 m 3 2 m 4 3 + r 2 I x3 I x4 m 2 m 3 3 m 4 2 )cos 3 (0 3 )+ 
r 2 I x3 I x4 m 2 2 m 3 2 m 4 2 cos(d?) 

[ 2 ] 

0 

[3] 

0 
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Table 4.2 (continued) 
x-i of x 2 
[ 1 ] 

(/ 3 2 77 z 4 4 r 3 2 m 3 -f 7 y4 + 7 y3 )sin(0 a )sin 2 (0 3 )4- 

((— / 3 2 m4 — r 3 2 m 3 — / y4 — 7 y3 -f 7,4 -(- 7, 3 ) cos(# 2 ) cos(# 3 )4- 

(— / 2 / 3 m 4 — r 3 / 2 m 3 ) cos(0 2 ))sin(0 3 )+ 

(44 + 7, 3 )sin(0 a )cos 2 (0 3 ) 

[2] 

0 

[ 3 ] 

0 

.r 2 of i 2 2 2 
[1] 

(((^3 2 — C 3 / 3 )m 3 + 7 y 4 + 7 y3 — 7, 4 — 7, 3 )r7l44- 
(7„4 4- 7 y3 — J X 4 — 7 r3 )m 3 )sin(0 a )sin 2 (^ 3 )-f- 
(((^3/3 — h 2 )rn 3 — / y 4 — / y3 4- 7, 4 -f J r3 )m4-f 
(“ 4* ~ 4a 4- 7, 4 4- 7, 3 )m 3 )cos(0 2 )cos(0 3 )sin(0 3 )4- 
((7 x4 4- 7,3 )m 4 4- (7,4 + 7, 3 )m 3 )sin(0 a ) 

[2] 

0 

[ 3 ] 

0 

X 2 of Xifji X 2 Z '2 

[ 1 ] 

(((/ 3 2 — 2? 3 / 3 4 r 3 2 )m 2 m 3 -f (7 y1 4- 7 y3 — I xA - I x3 )m 2 )m, x 2 + 

((/ 3 2 — 2 r 3 / 3 4- r 3 2 )m 2 m 3 2 -f ((/ 3 2 — 2r 3 / 3 4- »'3 2 )m 2 2 4- 

(27 y 4 4 27 y3 — 27,4 — 27, 3 )m 2 )m 3 4 (7 y 4 4- 7 y3 — 7,4 — I r3 )m 2 i ) 7 /? 4 4 

(/ y 4 + 7 y3 - 7,4 - I x3 )m 2 m 3 2 + (7 V 4 4- 4s - 4-. - 7, 3 )77/ 2 2 ? n 3 )sin(0 3 )sin 2 (0 3 )4 

(((-^3 2 4- 2r 3 / 3 - r 3 2 )m 2 m 3 4- (-7 y4 - 7 y3 4 I xi 4- 7, 3 )m 2 )m4 2 4 

((-/ 3 2 4- 2r 3 / 3 - r 3 2 )m 2 m 3 2 4 ((-/ 3 2 4 2r 3 / 3 - r 3 2 )m 2 2 4- 

(— 27 y 4 — 27 y3 4- 27,4 + 27 r3 )m 2 )m 3 4 (— 7 y 4 — 7 y3 4- 7,4 -4 I z3 )m 2 2 )m A -{- 

( — lyi ~ + 4-1 + 4-3) m 2 ?n 3 2 4 

( — 4 1 * — 4a + 4-1 4- 43)ro 2 2 m 3 ) cos(# 2 )cos(# 3 )sin(0 3 )4 

((44 + /*3)m 2 m 4 2 4 ((27,4 4 27, 3 )m 2 7?i 3 4- (7, 4 + 7, 3 )m 2 2 ) 77744- 

(7,4 4- 7, 3 )m 2 7n 3 2 4- (7,4 + 43)ra 2 2 ??i 3 )sin(0 3 ) 

[2] 

0 

[ 3 ] 

0 
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Table 4.2 (continued) 

X 2 Of X1.V1X2Z2X3Z3 
[ 1 ] 

((^r4*Jy4 "4“ ^x4^y3 -^x3-^x4 )^^2 ^^3^^4 ”1” ((-^r4^"y4 “f“ /r4^y3 ^x3^x4 ”f" 

(/x 4 ^y 4 + ^ 4^,3 - )sill(0 a )sill 2 (0 3 ) + 

(( ^x4^y4 ^r4^y3 *4" ^x3^x4 2^23^72 4 “f" 

(( ^x4^y4 ^x4^y3 4~ /c3^x4)^2^3 “I - 

( ^x4^y4 ^x4^y3 + Ir3l X 4)m2‘ 2 rn3)m4)cos(d 2 )cos(O 3 )sm(0 a )+ 

(I x 3l x 4m 2 m 3 m 4 2 + + /x 3 2r4™2 2 ™ 3 )»™4)sin(0 a ) 

[ 2 ] 

0 

[ 3 ] 

0 

x 2 of x l y l x 2 y2Z2X 3 y 3 z 3 
[1] 

(JxJy\ + Ir Jy 3 ~ ^3 ^x4 ) 2 777-3 777 4 3 S i 11 ( 0 3 )s I ll 4 ( 0 ; , ) + 

(~I x4 Iy < I - / X .|/ V 3 -f I x3 I x , l )m 2 2 m; ] rn, i 3 cos(0 2 )cos(0.,)si n 3 (0 ;i ) + 

(((2*4^4 + 4<|/y3 “ ^34-.|)'«2”i 3 ' 2 '».| 3 + 

( 2x4^4 + h- Jy 3 ~ ir3/x4) , ^2”l3 3 >«4 2 )cOS 2 (^ i ) + /*3-Ja;4»™2 2 ™3™4 3 + 

( 4.4 A/1 + /*4-fy3 - /x3/x4)m 2 2 »n3 2 m4 2 )sin(tf 3 )sin 2 (0 3 )+ 

((( ^x4^y4 ^x4^y3 “H Ax 3 Ax4 ) 77 7- 2 7 7 7 3 ^4 "f~ 

( -4x4 4/4 4' 4 fy3 ”i“ Ax 3 Ax4 )^73 2 ^77.3 777./ ) COS ( 0 2 ) f 

{-I x Jy 4 - 4*44/3 + /x3/x4)m 2 2 m3 2 77).4 2 cos(02))cos(03)sin(0 3 )4- 

{{I x3 Ix4m 2 m 3 2 m^ + /* 3 /*4m 2 m 3 3 77i.| 2 ) cos 2 (0 2 )+ 

/ x3 / x 4?772 2 m 3 2 777 4 2 )sill(0 3 ) 

[ 2 ] 

0 

[ 3 ] 

0 
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Table 4.2 (continued) 

Z 2 of Z'2 

[ 1 ] 

(h m 4 + r 3"i3) sin(0 2 )sin(0 3 ) + (— — 7' 3 7TO3)cos(0 a ) cos(# 3 )-|- 
(— hm 4 — / 2 m 3 )cos(0 a ) 

[2] 

0 

[ 3 ] 

0 

2 2 of ^2^2 

[1] 

(r 3 l 3 m 3 m 4 + ( r 3 I y4 -f r 3 I y3 — r 3 I x4 — r 3 I x3 )m 3 ) sin(0 2 )sin 3 (0 3 )+ 

(((—'3^ — ?' 3 / y3 + r 3 I x4 -f r 3 I x3 )m 3 — r 3 l 3 2 m 3 rn 4 )cos(9. J ) cos(0 3 )+ 

((-^3 2 «l3 ~ 7^2 ~ Itfh + I x ih + / r 3^)»«4 + 

{—lyih — 7 y3 / 2 + I X 4^i + 7 X 3/2)??i 3 )cos(0 a ))sin 2 (0 3 )4- 
(i'3lx4 + i' 3 I x3 )m 3 sin(0 2 )sin(0 3 )+ 

((— /r4 — I I 3 )h‘>n 4 + (—r 3 I x4 — r 3 I x3 )m 3 )cos(9 3 ) cos(0 3 )+ 

(( — 1x4^2 — I x 3h)^4 + (~ 7 x , t / 2 — ^r3^2)”i3)cos(0 a ) 

[2] 

0 

0 

z 2 of x 1 y l x 2 z 2 
[1] 

((((’’2 — h)h 2 + ''3(2/2 — 2r 2 )/ 3 + r 3 2 (r 2 — /2))m 2 m 3 + 

(Ix4(h ~ '’2) + 1x3(1 2 ~ '2) + -/y.|('’2 — ^2 ) + Iy3(l'2 ~ /2))'™2 )'™4 2 + 

(((r 2 — l 2 )l 3 2 -f r 3 (2/ 2 — 2 r 2 )/ 3 + 7’3 2 (7- 2 — / 2 ))77l 2 '773 2 + 

((( r 2 — ^2 )^3 2 + '’3(2/2 — 2 r 2 )/ 3 + 7’3 2 (7’ 2 — / 2 ))"7 2 2 + 

(/ X 4(2/ 2 - 2r 2 ) + I x3 (2l 2 - 2 r 2 ) + / H (2r 2 - 2/ 2 )+ 

"^1/3 (27*2 — 2/ 2 ))"72)'"3 + (I x 4(l 2 ~ ''2) + 7 x3 (/ 2 ~ 7' 2 ) + 

^•l( r 2 - /2) + / V 3(''2 - / 2 ))j77 2 2 )"i4 + 

(Ix4(h — r 2 ) + 7 x3 (/ 2 — V 2 ) -f- / y 4 ( 7*2 — / 2 ) + /y3('’2 — /2))'«2»n3 2 + 

(7*4 (/a ~ r 2 ) + 7 x3 (/ 2 — ''2) -f -f y .i(' - 2 — h) + Iy3(i'2 — h))™ 2 2 m 3 )cos(0 a ) sin 2 ( B 3 )+ 

(( — 1x4 — Ix3)hn^2 1r ^4 2 + ([{ — 1x4 — 1x3)1 3 — »’, 3^x4 — r 3 I x3 )m 2 m 3 + 

( — 7x4 — 7 x 3)/ 3 7n 2 2 )"74 + ( — 1'3lx4 — 1'3h3)m 2 m 3 2 + 

( — r 3^x4 — ''37 x3 )m2 2 m 3 )cos(0 a ) cos(# 3 ) + 

((7x4 (^2 — /z) + 7 r 3(r 2 — l 2 ))m 2 m 4 2 + ((7 X 4(27' 2 — 2/ 2 ) + I x3 (2r 2 — 2/ 2 ))7n 2 7n 3 + 
(I x4 (r 2 — / 2 ) 4- 7 x3 (r 2 — / 2 ))'7i2 2 )77i4 + (7^4(7’ 2 — / 2 ) + 7 x3 (r 2 — /2))7n 2 7n 3 2 + 

(7 X 4(r 2 — / 2 ) + 7 x3 (r 2 - /2))m2 2 m 3 )cos(0 a ) 

[2] 

0 

[ 3 ] 

0 
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Table 4.2 (continued) 

Z 2 Of XiyiX 2 Z 2 X 3 Z 3 

[1] 

{(I x3 I x 4 (/ 2 - r 2 ) + LJy*{r 2 - k) + W^a - l 2 ))m 2 m 3 m 4 + 

((Ixthiih ~ r a ) + I x Jyi(r 2 - l 2 ) + I x J y z(ri - i 2 ))m 2 m 3 ^+ 

(I x3 I x4 (l 2 - r 2 ) + I x J y4 {r 2 - /a) + hJyzfa - l 2 ))m 2 2 m 3 )m 4 )cos{9,)sm (0 3 )+ 
((-r 3 I x3 I x4 m 2 m 3 2 - r 3 I x3 I x4 m 2 2 m 3 )m 4 - r 3 I x3 I x4 m 2 m 3 m 4 2 )cos(9,) cos(9 3 )+ 
(I x3 I x4 (r 2 - / 2 )m 2 m 3 m 4 2 + (h 3^i-i( r 2 - /2)ni2™3 2 + 
hzhi{ r 2 ~ l2)m 2 2 m 3 )m 4 )cos{9^) 

[ 2 ] 

0 

[3] 

0 


z 2 of xiy\x 2 y 2 z 2 x 3 y 3 z 3 

[ 1 ] 

(•fr3-fx'l(^2 — r 2) "H Ixilyii. 1 ? ^ 2 ) + 

I x4 I y3 (r 2 - / 2 ))m 2 2 m 3 m 4 3 cos(0 a )sin 4 (^ 3 )4- 

(— ’’3-fx3-fx4 m 2 2 ? rl 3»«4 3 COs(0 a )cOs(^ 3 ) + ({I x3 h-l(h ~ + IxAly*{ r 2 ~ M + 

I x4 I y3 (r 2 - l 2 ))m 2 m 3 2 m 4 3 + {I x3 Ixi{h ~ r 2 ) + I x <Iyi{i '2 ~ h)+ 

I x4 I y3 (r 2 - / 2 ))m 2 m 3 3 m 4 2 )cos 3 (0 a )+ 

(hzhi{. r 2 ~ l 2 )m 2 2 m 3 m 4 3 + - r z) + ~ * 2 )+ 

I x4 I y 3 (r 2 - / 2 ))m 2 2 m 3 2 m 4 2 )cos(0 a ))sin 2 (0 3 )+ 

((— r 3 I x3 I x4 m 2 vi 3 2 m 4 3 — r 3 I x3 I x4 m 2 m 3 3 m 4 2 )cos 3 (9,)— 
r 3 I x3 I x4 m 2 2 m 3 2 m 4 2 cos(9 3 ))cos(9 3 ) + (hzh^'i ~ ^)” l 2» n 3 2 ” l 4 + 
I x3 I x4 {r 2 — / 2 )?72 2 m 3 3 m 4 2 )cos 3 (0 a ) + I x3 I x4 {r 2 - l 2 )m 2 2 m 3 2 m 4 2 cos(9.j ) 


[ 2 ] 

0 


[3] 

0 
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Table 4.2 (continued) 
x 3 of x 3 
[ 1 ] 

/ x4 cos(0 3 )sin(0 3 ) + / x4 sin(0 3 )cos(0 3 ) 

[ 2 ] 

0 

[3] 

0 

X 3 Of X 3 Z 3 

[ 1 ] 

l x4 m 4 cos(0 a )sin(0 3 ) + J x4 m 4 sin(0 3 )cos(0 3 ) 

[ 2 ] 

0 

[3] 

0 

x 3 of X\yix 2 z 2 x 3 z 3 
[1] 

((/ l4 / I/4 -f- IrJ V 3 )m 7 m 3 m 4 2 + (( I x4 I y4 + I x4 I v3 )m 2 m 3 2 + 

{IxilyA + -fr4-fs,3) j ™2 2 ”*3)rc* 4 )cos(0 3 )sin(0 3 ) 

[ 2 ] 

0 

[3] 

0 

X 3 of Xiy\X 2 y 2 Z 2 X 3 y 3 Z 3 
[1] 

[hdyi + h4l U 3)rn 2 2 m 3 m 4 :i cos(0 :i )s\n 3 (9 3 )+ 

(((Ix4l V 4 + Ix4l V 3)ixi 2 m 3 2 m 4 3 + ( I x4 I y4 + I x4 I y3 )m 2 m 3 3 m 4 2 )cos 3 (6 :> )-i- 

(/ x4 / y4 + i x 4 -f y 3 )m2 2 m 3 2 m 4 2 cos(0 3 ))sin(0_) 

[ 2 ] 

0 

[ 3 ] 
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Table 4.2 (continued) 
z 3 of Z3 
[ 1 ] 

l 3 m 4 sin(0 2 )sin(0 3 ) - l 3 m 4 cos(0 3 ) cos(0 3 ) - / 2 m 4 cos(0 3 ) 

[ 2 ] 

0 

[3] 

0 

Z 3 of X 3 Z 3 

[ 1 ] 

I X 4 hrn 4 sin(0 2 )sin(0 3 ) — / l4 / 3 m 4 cos(0 a )cos(0 3 ) — / l4 /2 f ^4cos(0 a ) 

[ 2 ] 

0 

[3] 

0 

Z 3 of X\y\XiZiX3Z3 

[ 1 ] 

(I c 3 / r4 (r 3 - / 3 )m 2 m 3 m 4 2 + (I x 3 I x 4 (r 3 - / 3 )ni 2 m 3 -f 
Ix 3 lx 4 (r 3 - / 3 )m 2 2 m 3 )m 4 )cos(0 3 )cos(0 3 ) 

[ 2 ] 

0 

[3] 

0 

z 3 of x\y\Xi])?ziX 3 y 3 z 3 

[ 1 ] 

- /3)m 2 2 m 3 m 4 3 cos(0 3 )cos(0 3 )sin 2 (0 3 )+ 

((^i3-fi4( r 3 - / 3 )m 2 m 3 2 m 4 3 + /* 3-fx-4(»’3 “ / 3 )” l 2^3 3m 4 2 )cOS 3 (0 3 ) + 
IxzI X 4 (r 3 - / 3 )m 2 2 m 3 2 m 4 2 cos(0 3 ))cos(0 3 ) 

[ 2 ] 

0 

[3] 

0 


4.4 Controllability of Inaccessible Vibratory Modes 

It is well known that for a linear, time invariant system 


i = Ax + Bu € ft" 


(4.33) 
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the global controllability can be examined by the rank of the controllability 
matrix 

V =[B AB A 2 B • • • A n ~'B\ (4.34) 

If T has a rank n then the control space of u covers TV 1 and every desired state 
could be reached in finite time. However, nonlinear system controllability can 
only be examined point by point (local controllability). Local controllability 
indicates the reachability of a local point by any nearby point inside a small 
region surrounding that local point. If every local point is controllable and 
the union of all small reachable regions covers the whole state space, then the 
global controllability of nonlinear system is ensured. According to Kalman’s 
discussion in [Markus and Lee, 1962], for a nonlinear system 


x = f(t,x,u) 


(4.35) 


the local controllability at (x 0 ,t/„) can be detected by linearizing the nonlin- 
ear equation around the given point and then checking the controllability of 
the linear equation. This method will be used here to investigate the control- 
lability of inaccessible modes. The results will show the distinction between 
accessibility and controllability of vibratory modes. Recalling that compliant 
manipulator system control equation is defined by 


' 9 ‘ 


" A x 

C T 1 

r l 


' Ax ‘ 

J. 


C 

A 2 

1 

1 

< 

1 

C 


u 


(4.30) 


Let 


6 

P 


Xl = 

and also set 


<E 'R n9+n < 1 ; x 2 = 


e 


e 7 l ne+n P ; X = 


X\ 

x 2 


6 7l 2{ne+n ^ (4.37) 


h(xi , x 2 ) 


1 

o 

H 

1 

1 

. c a 2 J 

l ~h - Kfi J 


e 7l n ‘ ,+n ' s 


(4.38) 
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and 


A i 
C 


W(x i) = 

then Equation 4.36 could be written in a state space form as 


(4.39) 


X\ — x 2 

x 2 = h(x l ,x 2 ) + W{x 1 )u (4.40) 

whose variational equation around an operational point (xi,x 2 ,u) is 

Sx i = Sx 2 

Si, = Sh(i i,*0+W*i)“) ( 4 - 4l > 

By taking the first order approximation, the variational equation has a linear 
form 


6xi = Sx 2 

Sx 2 = $i<5xi + $ 2 6x 2 + ty(xi)5u 


(4.42) 


where 


*i 

$2 


dh(x i,x 2 ) 


dx\ 

dh(x i,x 2 ) 


+ 


dW(xi) 


u 


dx 2 


dxi 

g 7£( n »+ n /O x ( n «+ n 0) 


g 72,( n #+ n /j) x ( n e+ n ^) 


(4.43) 


whose elements could be 

expressed in a more 

detailed form as 


Oh' 


-c*1<aT 

cd|cc> <ol<E> 

dhj ... 8^1 

502 90ng 

dhx ... 3^2 

602 30„ # 

dhx 

dpi 

dhi 

dpi 

dhx 

dpi 

dh2 , . . 

dp2 

0/ij 1 

901*/) 

9h 2 

dPnp 

dxi 


dhfiQ + np dh n$ +np dhn e +np 

801 901 90 ne 

dhng+np 

dpi 

dhn 0 +np 

dpi 

dh n0 + r\p 

90 np 


= 

8h 9h 

50i 502 

6/» 9h 9h . 

" Wi w* 

dh 

] 

(4.44 
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where hi is the rth element of vector k, similarly 


dW 


BW,, 

BW,. 

aw .. 

BW,, 

aw 

dW 

dxi U 


w; u 

m u 



■ 

' ' ^r B u | 


(4.45) 


and 


' dh' 

f dh_ 

dh 

dh dh dh 

dh i 

dx 2 

~ [ d$ x 

d$ 7 

d$n e dpi d02 

J 


(4.46) 


With these defined notations, Equation 4.42 could be expressed ns a linear 
state equation 


6x 


0 I 

$i $. 2 

ASx 4- Bdu 


Sx + 



(4.47) 


where X is an (n e + np) x (n.g + np) identity matrix, A G 7v 2 ( n o +,, /9) x2 ( ,1 e+'»^) ) 
and B G , 


From Equations 4.34 and 4.47, the controllability matrix of the lin- 
earized system is given by 


$ = 


B AB A 2 B • ^ 2 («o+-m)-i 

0 W <f> 2 W ($, + <I> 2 )H’ 

W $ 2 W ($j+$ 2 )W ($,$ 2 + $2*1 +<I>2)TF 


(4.48) 


whose rank serves as an indicator of the local controllability of the original 
nonlinear- system in Equation 4.36. Since <J>, and $ 2 are functions of 6>, /*, 
9, $, and ti, and W is a function of 9 and /?, the rank of $ relies on the 
specific operational point ( x 0l u o ) around which the system is linearized. In 
the following sections, two examples will be presented. The first example 
is a one-link arm modeled with one lumped lateral deflection, where due to 
the specific kinematic structure the vibratory mode is always inaccessible 
and uncontrollable. The second example is a two-link arm modeled with one 
lumped lateral vibratory mode which turns out to be controllable even in an 
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inaccessible position. Both examples are studied by the symbolic program 
MACSYMA, and due to computer memory limitations, some simplifications 
are applied in order to obtain the final results. 


4.4.1 Example 1 

The first example model is shown in Figure 4.4 (a), in which (X,Y,Z) 
is the global coordinate frame, and (Ai, Yi , Z\) is the local frame of the arm. 
The link has mass m\ and moment of inertia I\. The mass is located at a 
distance r from the joint axis, and the link length is l. A payload is added 
to the end of the link, which has mass ?ti 2 mid moment of incitia I 2 . The 
vibratory mode is modeled at the end of the arm and parallel to Z\ direction. 
Then the dynamic equations arc described by 

(I\ + h + mp- 2 + m 2 / 2 )0 = u 

mtf + KP = 0 (4.49) 


where K is the modeled spring stillness. Letting a — (1) + I 2 + m i J ' 2 T ), 


the inverse of the inertial matrix is expressed as 


' A, 

C T ' 


' 1 
a 

0 

C 

A 2 


0 

1 

t?i2 . 


(4.50) 


which indicates that the lxl dimensional C matrix is given by C 0. This 
suggests that oscillation 0 always remains inaccessible. Since the derived 
dynamic equations are linear and time invariant, they could be expressed in 
a state space form as 


' 6 ' 

r 

ft 


e 


J . 



0 

0 

0 

0 


0 

0 

0 


K 

m2 


1 0 
0 1 
0 0 
0 0 



' 6 ' 


■ 0 ■ 


P 


0 


e 

+ 

\ 

a 

J 

0 


_ 0 . 


u 


(4.51) 
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and the controllability matrix is 


* 


0 i 0 0 ' 
0 0 0 0 
\ 0 0 0 
0 0 0 0 


(4.52) 


which, possesses only two independent columns so it has a rank of two. Since 
'I' does not have a full rank, the system is uncontrollable. Hence in this exam- 
ple, the controller loses both controllability and accessibility of the vibratory 
mode. 


4.4.2 Example 2 

Tlu- second example is depicted in Figure 4.4 (b), which is a two- 
link arm modeled with one vibratory mode. The first link has a local frame 
(A i , l'i , Z) ), and that of the second link is (A 2 , T 2 > Z 2 ). The second link is 
oscillating laterally along Z> direction. Each link length is indicated in the 
figure. For simplicity in analysis, the links are assumed massless, only the 
payload is considered to have a mass m 3 and a moment of inertia / 3 around 
the X 2 axis. Then the system dynamics is given by 




’01 ' 


u, 

h 

+ f = 

U-2 

. 0 . 


0 


(4.53) 


or 


Bi 

0-t 

(i 


= (/•)■'(-/) + (/T I « 

= h + lVu 


(4.54) 


in which /* is the generalized inertia matrix which is symbolically derived as 

h + ?'i3/3 2 + (m 3 /j - / 3 ) cos 2 (0 2 ) -m 3 / 2 sin (0 2 )/? — m 3 / 2 cos(0 2 ) 

r = I -ro 3 / 2 sm(0 2 )P m 3 l\ 0 

— m 3 / 2 cos(0 2 ) 0 m 3 
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Z,Zi 



(a) : Example 1 

X 2 

(Z 2 ) 


Y 





no 


and / contains the Coriolis, centrifugal, gravitational, and spring force effects, 
and is described by 

’ — 2 (m 3 /| — / 3 )cos( 02 )sin( 02 )^i ^2 — *« 3 /2 cos{8 2 )08\ -f 2 m 3 /?f? 1 /j 
/ = (m 3 l\ - I 3 ) cos(8 2 ) s'm(8 2 )8l - 2m 3 l 2 sm(8 2 )8^0 + m 3 ji / 2 cos( 0 2 ) 

-m 3 08\ + 2 m 3 l 2 sm(6 2 )6i6 2 + K(3 

where g is the gravitational acceleration, and K is the modeled spring stiff- 
ness. The inaccessible position of the modeled vibratory mode is determined 
from the submatrix C of (J*) -1 , which has a symbolic form 

C = 7723/2 cos (^ 2 ) 7Ji 3 / 2 cos( 0 2 )sin(^ 2 )/^] 

A = (mll 3 l 2 )sm 2 (9 2 ) + (mlll/3 2 )cos 2 (8 2 ) (4.55) 

Apparently, cos(0 2 ) = 0 gives the inaccessible position, i.e., when the second 
link is vertical and collinear with the first joint, or 8 2 — 90 degrees, both 
actuator inputs can not access 0. To check the local controllability in this 
inaccessible position, the nonlinear system defined in Equation 4.54 will be 
linearized around an operational state described by 


{8i,8 2 ,0,8 l ,8 2 ,0 ) ui,u 2 } — {0 lo ,9O°, 0, 8i 0 ,8 2o , 0 o , iii 0 , u 2o ] 


where subscript o denotes the constant values of a selected operational state, 
and 8 2 is chosen to be 90 degrees to include the inaccessibility condition. The 
linear variational equation 6x = A8x + B6u of the nonlinear system is derived 
symbolically around the operational point and the matrices A and B take the 
following form 

'0 0 0 1 00' 

0 0 0 0 1 0 

0 0 0 0 0 1 

A = 0 2 8 1o 8 2o ^ 0 0 0 

ft (™3<2-/3)tfi 0 +m3fl<3 uxa Ma ft Mia 

U m3 if hh h U h 

0 —2l 2 8 2o - 2 l 2 8 lo 0 


(4.56) 
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B = 


0 

0 

0 

\_ 

h 

0 

0 


0 

0 

0 

0 


(4.57) 


A controllability matrix $ is formed by using the above A and B. In this 
case, n g = 2 and n Q = 1, so is a 6 x 12 matrix. To check the full rank of 
the determinants of two submatrices of are derived, which are 


dct[U AB A 2 B ] = 


202qUIo 

m 3^2 


(4.58) 


and 


i ha 2 $ 2 

det 


djpU io _ (m 3 fl ? 0 - K)Po 

h 


(4.59) 


since these determinants can have nonzero values, * can have a full rank. 
Therefore, the nonlinear system is locally controllable around an inaccessible 
position. This result indicates that inaccessibility does not necessarily imply 
uncontrollability. But as pointed out before, in an inaccessible position the 
vibratory mode is governed by nonlinear terms composed of centrifugal, Cori- 
olis, gravitational, and spring forces. Without the direct access of the control 
input, it is very difficult to dampen the vibrations through the nonlinear term 

f 2 and spring force K (3. 



Chapter 5 


Controller Design for Compliant Manipulators with 
Well-Known System Parameters 


In a linear system of equations Ax - y, where A € 7 £ n * Xn v, x € ft" 1 , 
and y E H ny , the matrix A assigns a y for a given x. Let A' C 7l n 1 be the set 
of all such x and y C be the set of corresponding y, then A' is defined 
as the domain of A and y is the range of A. If the mapping from A' to y 
is bijective, i.e., one-to-one and y = H ny , then an inverse map exists such 
that for every element y € 7?."*' there is a unique solution x G A* satisfying 
the equation. Since A is generally not a full-rank square matrix, existence 
and uniqueness of solution x is not guaranteed for any y. For example, if 
n x > n v , let X 1 C X be a subset defined as X 1 = {x 1 : Ax 1 = 0; a;- 1 € A'} 

, i.e., A' 1 is the nullspace of A, then for every element x* — x + x x , x € A 
and x- 1 - 6 A' J ', Ax* = y, which means that for a given y the solution is 
indecisive. Another example may be given as follows: if n x < n„ and if we 
let y 1 C ft"* denote the complement of y, then for a given y* = y + y x , 
y e y and y x G > ?x , there is no solution for the equation Ax = y*, which 
means that since A has a rank smaller than n y its column space can not span 
7Z nv , hence solution does not exit unless y* is in the column space of A. The 
first example is sometimes referred as redundant problem, and the second 
example is overdetermined problem. It will be shown in this chapter that 
the controller design of compliant manipulators has the nature of solving 
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an overdetermined problem, but after choosing proper control criteria the 
controller design becomes solving a redundant problem. 


5.1 The Difficulty of Ideal Acceleration Assignment 

According to the third chapter results, compliant manipulator sys- 
tem dynamics have a common symbolic form 


Aj E 
E A 2 


e 

L 0 J 


+ 


fi 

h 4 I<P 


u 

0 


(5.1) 


for both distributed and lumped parameter models, in which the first ma- 
trix represents the generalized inertia associated with nominal and vibratory 
modes, and its inverse is defined in Equation 4.7 as 

(5.2) 

Premultiplying Equation 5.1 by the inverse above, the dynamic equations 
become 


' A! 

E T ' 

-I 

' Ai 

C T 

E 

a 2 


C 

A 2 


' 6 ‘ 
J . 

*( 

' A x ' 
C 

f\ + 

■ c r ■ 
A 2 

(f 2 + Kff)) = 

At 

C 


(5.3) 

Ideally, it is desirable to select a proper u so that the accelerations obtain the 
PID state feedback and feedforward values defined by the following relations. 


' 8 ' 


u l 

. P . 


u 2 _ 


(5.4) 


where 


«1 = 0r+ K v o{6 - 9 r ) + K v e{6 - 8 r ) + K je 0 r )<*<} 

u 2 = 0 r + K v0 (j3 - p r ) + K pP (P - 0 T ) 4 Kjp {- J((3- /3 r )dt\ (5.5) 

in which 0 r and represent the desired states, and K v , , K pi , and K Iif i = 
0, /?, are separately the stable velocity, position, and integral gains with 



114 


appropriate dimensions. Generally, 9 r is predefined by given task, and p r and 
its time derivatives are chosen to be zero in order to eliminate vibiations. 
Additionally, the feedback gain matrices /v ui , A pi , and A/, are diagonal which 
decouple Equation 5.5. If the acceleration assignment is achieved then the 
combination of Equations 5.4 and 5.5 pioduces 


(6 - 0 r ) - K v0 {6 - Or) ~ K v o{9 - 0 r ) 4- K u [J ( 9 ~ 9 r) df ) = 0 
0 - Pr) - I<V00 - Pr) - K AP - Pr) + {J (P ~ PM*} = 0 ( 5 ' G ) 


which indicates that by choosing stable feedback gains nominal joints will 
track the given task trace, i.e., 0 -» 9 r , and structural oscillation will be 
removed at the same time, i.e., fi -* = 0- However in Equation 5.3, both 

acceleration and nonlinear terms in the left-hand side of the equation ate in 
7 i»o+n fi S p acc ( but the control space of u is composed by the n 0 column vectors 
of [A]* C T ] T which covers only a portion of R' l «+ n « . So for a given desired 
acceleration [u]’uJ] T , its sum with the second nonlinear term in Equation 5.3 
might not reside in the control space of it, which means that by defining 


y = 


Ml 
M 2 


+ 



c r 

A2 


(h + I<P) 


(5.7) 

(5.8) 


and setting x = u, finding an ideal acceleration assignment u is equivalent to 
solving an overdetermined equation Ax = y. Obviously, a solution x exists 
only when y is in the range of A, which is generally difficult to verify for a 
moving robot. Therefore, direct acceleration assignment is not practical for 
the control of compliant manipulators due to the dimensional mismatch be- 
tween the number of modeled degrees of freedom and the available actuatois. 
By contrast, in the control of rigid manipulators where structural compliance 
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is neglected, every joint, or degree of freedom, is accompanied by an actu- 
ator, so direct acceleration assignment is possible after nonlinear compen- 
sation of Coriolis, centrifugal, and gravitational forces. Unfortunately, such 
nonlinear compensation techniques can not be extended directly to compliant 
manipulators where additional vibratory modes are added to system motion 
description. Hence, dimensional mismatch makes the control of compliant 
manipulators a difficult and therefore challenging task. 

5.2 The Theorems of the Lyapunov’s Second Method 

Since direct acceleration assignment is not applicable in the control 
of compliant manipulators, certain stability criteria must be adopted to fa- 
cilitate the controller design. The stability criteria chosen in the following 
controller designs are derived by Lyapunov, which arc stated in the following 
theorems [Landau, 1979 ]. 

Theorem 5.1 (Lyapunov) Consider the free dynamic system 

& =/(*,*) ( 5 . 9 ) 

where /( 0 , t) = 0 for all t. If there exits a real scalar function V(x,t) with 
continuous first partial derivatives with respect to x and t such that 

1 . U(0, <) = 0 for all t 

2 . V(x,t) > ar(HiH) > 0 for all x 7^ 0, x £ 7 v'', and for all t, where o( • ) is 
a real, continuous, nondecreasing scalar function such that <v(0) = 0 

8 . V(x ,t) — ► oo as ||x|| — + oo for all t 

4 - V = &V(x % t) = §- t V + (grad V) T f(x,t) < -7(||x||) < 0 where 7( ) is a 
real, continuous, scalar function such that 7(0) = 0 
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then the equilibrium state x, = 0 is globally asymptotically stable, and V (x,t) 
is a Lyapunov function for this system. 

Corollary 5.1 The equilibrium state x± = Q of the autonomous dynamic 
system 

k = /U) 

is globally asymptotically stable if there exists areal scalar function V(x) with 
continuous first partial derivatives with respect to x such that 

1. V(0) = 0 

2. V(x) > 0 for all x ^ 0, x € 7v n 
S. V(x) — ► oo as ||x|| -+ oo 

4. V = ^V(x) < 0 for all x ^ 0, x G K n 

Corollary 5.2 In the above Corollary, condition 4 ma V be replaced by 
4-1 V(£) < 0 for all 0, x G H' 1 

4.2 ^(^(iiaLot^o)) does not vanish identically int > t n for any t 0 and x^ ^ 0, 
where <f>ft', Xo,t 0 ) is a solution of Equation 5.9 and £(to;£o,*o) = £a 

Finally, for linear time-invariant free dynamic system, Lyapunov provides the 
following theorem giving the necessary and sufficient conditions for globally 

asymptotically stability. 

Theorem 5.2 The equilibrium state x, = Q of a linear time- invariant free 
dynamic system 


x — Ax 


( 5 . 10 ) 
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is ( globally ) asymptotically stable if and only if given any positive definite 
matrix Q there exists a symmetric positive definite matrix P which is the 
unique solution of the matrix equation 

A T P -f PA = —Q 

and V = x 1 Px is a Lyapunov function for the system in Equation 5.10. 

In applying the Lyapunov’s second method, a continuous, positive 
definite scalar function, or the Lyapunov function, is defined first. This posi- 
tive Lyapunov function generally represents a. distance, or error, between an 
instant state and the desired state. Then by formulating the system con- 
troller properly, the Lyapunov function produces a negative rate as long as it 
remains a positive value, which means that the distance and hence the state 
01101 1 educed continuously until a zero error is met. Since this method 

studies stability problem in TV space, it is very useful to solve multi-degree- 
of-fieedom control problems like the control of compliant manipulators. It 
will be shown later that by using the Lyapunov’s second method the control 
design becomes solving the redundant problem instead of the overdetermined 
problem in the direct acceleration assignment. 

Seveial controller structures will be introduced in the following sec- 
tions. Before presenting these control algorithms, it should be noticed that to 
maintain generality of the results the nonlinear nature of system dynamics is 
considered in the design process. No linearization or ignoring nonlinear term 
is assumed to simplify the control design problem. However, two assump- 
tions are used in building the following controllers, which are: (1) system 
paiameters including payload are well-known, but in later example simula- 
tions payload uncertainty are added to test controller robustness, and (2) all 
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nominal and vibrational displacement and velocity states are available on- 
line. The first assumption is generally true for a well calibrated system. As 
for the second assumption, robot joint position and velocity could be read 
from attached resolver and tachometers directly, and modal amplitudes and 
velocities could be measured and reconstructed from strain-gauge leadings. 
Therefore the second assumption is technically feasible. Examples of on-line 
measurement of vibratory states for the motion control of compliant arm have 
been reported by [Hasting and Book, 19SG] and [Cannon and Schmitz, 1984]. 

5.3 Orthogonal Projection Method 

The first controller is designed by the orthogonal projection method. 
As mentioned in the direct acceleration assignment, finding a proper input to 
produce the ideal acceleration response is solving a linear equation described 
by Ax — y, where A has more rows than columns. If A has a full column 
rank then (A 7 'A) _1 exists, and there is a left-inverse (A T A)~ 1 A T such that 
x — f A 7 " A) - ' A 7 y which represents an approximated solution with minimum 

error 

||y - itx|U = 11(1 - A(A t A)-'A t ),j\\ 

where I is an identity matrix and A(A T A)-'A r is a projection matrix from 
y to the column space of A. Because 

A T {y - Ax) = 0 

the solution x = (A T A) _1 A T y could be considered geometrically as an or- 
thogonal projection of y on the column space of A. Since the orthogonal 
projection solution x can not generate the exact y, it could not be used alone 
to construct the input command. However, the orthogonal projection matrix 
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( A T A)~ 1 A T is a linear map from 7l ne + n e space to TZ n ° space, which allows us 
to transfer control design from TZ ne space to TZ n «+ n P space where the ideal ac- 
celeration [uf, u 2 ] r resides. After constructing the controller in 7£. n#+ "' 3 space, 
the result is projected back to TZ ne space to obtain the final input command. 
Therefore, orthogonal projection will bo used as a starting point in the fol- 
lowing design process. Since the orthogonal projection does not guarantee 
the ideal acceleration assignment, the Lyapunov’s second method will be em- 
ployed as the criteria to build a stable controller in 7£"» +n / 5 space. First, the 
dynamic equations defined in Equation 5.3 are rewritten as 





£]'('» + *«) 


then by selecting a composite input command 


(5.11) 



(5.15) 
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is invertible. So, it is possible to choose a set of input, [u^ u^} T defined in 
K n ' +n ’ space that produces a u 3 in 7l n ° by the following relations 


«3 


def 


w c*i 

\ 

= «-'[AtC T \ 


Ai 

C 


-1 


[a 1 ; c’i 


U 4 

Us 


U4 

Us 


(5.16) 


By substituting the above u.i into Equation 5.13, tlie dynamic equations be- 


come 


with 



= 

£ a- x [A[C r ] 


D, Bf 

U4 

= 

b 2 b 3 

Us 


Bi = Ait*- 1 At 


u 4 
« 5 

+ 7i 


+ 7i 


D 2 = Ca~ l Aj 
B 3 = Ca~ l C r 


(5.17) 


(5.18) 


As mentioned before, the orthogonal projection matrix 

o-M AJC T ] 

converts the control input from an n e vector, u 3 , to an (n 0 + np) vector , 
[ U T K TjT After designing the control input [ttj uJ] T t the actual input u 3 
is generated by Equation 5.16. In the above definitions, B x is an invertible 
matrix for A x lias full rank, and B 3 is a symmetric matrix. Provided that C 
has full row rank then B 3 is also invertible. In case that B 3 1 exists, u 4 and 
u 5 could be further defined as 

u 4 = Bf x (ui + ue) 

«5 = B 3 l (u 2 + u 7 ) 


(5.19) 
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where and u 2 are the desired accelerations given in Equation 5.5, and 
and 117 will be defined later by the Lyapunov’s second method. With these 
new u 4 and tt 5 , Equation 5.17 becomes 


' 6 ' 



+ 

r 1 
u 6 

+ 

BJB 3 1 (u 2 4 - tt 7 ) 

W ■ 


. 112 . 

. Uj i 

B 2 Bi\ui + tt 6 ) 


+ 7i 


(5.20) 


where the first term in the right-hand side is the desired acceleration, the 
second term is the input vector to be assigned, and the rest represent nonlinear 
disturbance to the above control system. Equation 5.20 could be converted 
into error-driven system dynamics by the following definitions. Let 


€1 = 


e-e r 

P-Pr 


£ 7?. n »+ n 0 


e 2 = Ci 


e 3 = -e t 


be the error states and 


e — 


Cl 

e 2 

c 3 


£ 7^ 3 ( ”(»+"/?) 


(5.21) 


Kp = 

B p$ 
0 

0 

KpP . 

g 7^( n «+ n ^) x ( n tf+ n ^) 

(5.22) 

K v = 

Kvo 

0 

r 1 

g 7£( n o+ n 0) x ( n 0+ n £) 

(5.23) 

I<i = 

' Ki, 
0 

1 1 


(5.24) 


be the new grouped gain matrices, then Equation 5.20 could be transformed 
into error-driven system dynamic equations 


with 


e = Ae -f- Dw 



1 

K v 

0 


0 ' 
Ki 
0 


(5.25) 


g 'Jl 3 ( n o+ n p) x 3 ( n o+np) 


(5.20) 
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B 


0 

I 

0 


and 



u 6 


P 3 X ( u 2 + u 7) 

w = 

u 7 

+ 

BiB\ X («i + ue) 


+ 7i 


(5.27) 


(5.28) 


where 1 is an (n, + >.«,) x (n, + »,) identity matrix. For constant feedback 
gain matrices K„ K„ and A',, Equation 5.25 is a linear time-invariant system 
with disturbance to. So, a quadratic form Lyapunov function is selected as 

v — p t Pe e P . 1 (5.29) 


whose derivative could be derived from Equation 5.25 as 

V = e T Pe + e 1 Pe 

= e T (A T P + PA)e + 2e T PBw 

= —e T Qe + 2e T PBw ( 5 - 30 ) 

where P and Q are positive definite matrices with P and Q <E 7l 3 (" 9+n ' 5)x3(nfl+ p) 
Also by Theorem 5.2, for a stable matrix A, P and Q satisfy the following 

relation 

a t p + pa = -q ( 531 > 

which is often called the Lyapunov matrix equation. Notice that A is a stable 
matrix whose eigenvalues are decided by the gam matrices m Equation 5.26. 
In Equation 5.30, V is composed of a negative quadratic term and a nonlinear 
disturbance io. Recalling from the definition of to in Equation 5.28 that the 
control input u 6 and u 7 in to are left to be decided. Therefore, they could be 

selected such that 


e T PBw < 0 


(5.32) 
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is satisfied. If Equation 5.32 is accomplished then V > 0 and V < 0, for all 
e / 0. Consequently, according to Corollary 5.1, e -♦ 0 which implies that 
0 -> 9 r and /? — ♦ = 0. Since one of the sufficient conditions for V < 0 

is e PBw = 0, Ue and Uj will be solved based on this criterion. First by 
dividing P into nine (»* + n 0 ) x ( n g + n p ) submatrices 

' Pi Pi P 3 ' 

P = P? Pi P 5 (5.33) 

L PI PI Pe J 

and following the previous definitions that e T — [ej ej] and D = [0X0] T , 
then 

c r PD = ej Pi + cl Pi + dPj 

<1of r T 7’i 

= l'h Vi] (5.34) 

wit.li ;/, £ 7v no and ?/ 2 £ Dy these new notations, the scalar equation 

e 1 PBw = 0 could be expressed by 

c t PBw = + vl'B 2 B; l )u« + (, 1 l + ,,lBlB; l )u 7 

+ (vj Pj P 3 'ui + »/•] PiB^ x u\ -f [itf '/if] 7i) 

= * T a 8 + 72 

= 0 € K 1 (5.35) 

with 

® = [( ? /f + ViBiB\ 1 ) {i)l + i]l Bj B^ 1 )} (5.36) 

Us = “® G n n ° +n » (5.37) 

and 

72 = (vfpj P^ui + rfiBiBi'ii! + [ill 7 2 T ] 7l ) (5.38) 
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Since Equation 5.35 is a scalar equation, and u 8 is an (n 0 + n p ) vector, finding 
a ug satisfying Equation 5.35 is solving a redundant problem. Here a solution 
with a minimum norm ||u 8 || value is selected, which is 


72 \T» 


(5.39) 


provided that + 0. After solving tig, the controller design is accomplished. 
Now, V > 0 and V < 0, for all e f 0, and according to the Lyapunov 
theory, the error state converges asymptotically to null state. Consequently, 
both nominal trajectory tracking and vibration elimination are retained. It 
should be noticed that by using the Lyapunov stability criteria, compliant 
manipulator control design is transformed from an overdetermined to a re- 
dundant problem. To construct the final command input u, the u 8 defined 
in Equations 5.37 and 5.39 and the ideal accelerations u, and u 2 given in 
Equation 5.5 are substituted into Equation 5.19 to produce u 4 and u 5 which 
are then projected back to Jl n ° space to generate u 3 by Equation 5.16. The 
final command input u is the sum of u 3 and nonlinear term /, as stated in 
Equation 5.12. Then according to the above analyses, the input u will ful- 
fill the Lyapunov stability criterion and hence stabilize the nominal tracking 
motion and structural oscillations. 


5.4 Restrictions of the Projection Method 

In developing the control law by the projection method, two analytic 
assumptions are proposed. First, it is assumed that 

B 3 = Ca~'C T 

is invertible, which means that C must maintain full row rank during the 
control process. Since C is an (n„ x n.) matrix, to have a full row rank 
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implies that n 0 < n e . So the projection method is restricted to the case that 
the number of modeled vibratory modes is not greater than that of nominal 
joints. Also, inaccessible vibratory modes must be avoided during operation, 
since a row or rows of zero in C will make B 3 not invertible. 

Another assumption applied on Equation 5.39 is that $ ^ 0 . Ac- 
cording to Equation 5.35, when 'I ; = 0 , the derivative of the Lyapunov func- 
tion in Equation 5.30 becomes 


V = -c T Qe + 2 72 (5.40) 

where 72 is given by Equation 5.38. In that case, V is affected by the nature 
of 7 2 . If 72 remains negative then V < 0 and the stability proof remains valid. 
Otherwise, V becomes positive when 

272 > e T Qe > 0 (5.41) 

which means that when e is inside a spherical ball , e T Qe, bounded by the 
asymptotical conveigence of the error state is not ensured. Geometrically, an 
error state outside the spherical ball will be driven toward the ball continu- 
ously by control input, once the error state enters the ball it will be confined 
inside the ball but the destination is uncertain. Obviously, by reducing the 
size of the spherical ball, the uncertain error state will set closer to zero. In 
the following, we will discuss how to reduce the size of uncertain spherical 
ball. Recalling that the definition of 72 is given by 

72 = (v{b 1 b;'u 2 + nlB 2 B?u 2 + [vlrihi) 

where B j, B 2y B 3 , and 71 are system properties which can not be manipulated 
directly during a task, and Ui and u 2 are the ideal accelerations which can 
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be reduced only by using small gains. Hence, the major reduction must be 
accomplished by i] X and i} 2 . By Equation 5.34 

rf] = efft + ^2 P* + 

where e,, i 6 { 1 , 2 , 3 }, are the on-line state errors, so ?/, and i] 2 can be reduced 
by choosing small P 2 , P«, and P 6 . However, positive definite matrix P is 
generally solved numerically from the Lyapunov matrix equation 

A t P + PA = -Q 

for a given stable matrix A and a positive definite matrix Q. So the selection 
of P is not arbitrary because the Lyapunov matrix equation relationship must 
be maintained. In the next section, an explicit solution of P for a specific 
set of A and Q will be presented. These results will show how to obtain a 
desirable P structure from the adjustment of Q values. Hence a small P could 
be constructed in terms of Q to reduce the uncertain ball in the above stability 
analyses. Case studies of using the orthogonal projection method to control 
a six-link manipulator modeled with four joint or four link compliances are 
reported in [Tosunoglu, Lin, and Tesar, 1990, a]. 

5.5 Solution of the Lyapunov Matrix Equation 

According to Theorem 5.2, for a stable matrix A and a given positive 
definite matrix Q, there exits a unique positive definite matrix P such that 

A T P + PA = ~Q 

Hence in general control design, P is not chosen directly but solved from the 
Lyapunov matrix equation for a given pair of A and Q. Generally, numerical 
methods are used to solve the Lyapunov matrix equation. However, Q is 
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practically chosen to be diagonal for high dimensional systems, and the gain 
matrices A',,, A'„, and Kj are usually diagonal to decouple the final state 
equations. For these particular A and Q matrices, P can be solved explicitly 

in terms of the submatrices of A and Q. In Equation 5.2G, A is given as 

'0 JO' 

A = K p K v K, e ft 3 («*+»*)x3(»,+n„) 

_ -1 0 0 

and in Equation 5.33, P is divided evenly into nine [rig + np) x (n e + np) 
sub mat rices 

' Pi P 2 Pj ' 

P= P 2 r P 4 P 5 

LPT PI Pe\ 

For a diagonal Q defined as 

' Qx 0 O' 

Q - 0 Q 2 0 (5.42) 

.0 0 q 3 

where Q,, i £ {1,2,3}, are (n$ + np) x (rig + np) diagonal submatrices, the 
submatrices of P have the following explicit solutions: 

2 Pt = (/v 2 - K p )DQi + (A; 2 - K V K,)DQ 2 + (/ - K*Ky')DQ 3 
2 P 2 = -K v DQi + I<iDQ 2 + K 2 jq l DQ s 
2 P 3 = -KiDQt + K p K,DQ 2 + K p K 2 v Kj l DQ 3 
2 P 4 = DQi - K p DQ 2 - K v Kf l DQ a 
2 P 5 = -KT'Qz 

2Pq = -K v K,DQi + K]DQ 2 + (AT 2 + K p - K 2 h' v Kj l )DQ 3 (5.43) 

with 

D = (K P K V - A'/)' 1 (5.44) 

This solution is obtained by using the facts that diagonal matrices remain 
commutative under multiplication, and P is the unique solution of the Lya- 
punov matrix equation. Notice that P,, i € {1,2, 3, 4, 5, 6}, are diagonal 
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matrices and linear functions of Q u Qu and Q 3 . Since A is a stable matrix, 
and K p , I<v, and I<i are diagonal matrices, it could be shown by the Routh- 
Hurwitz criterion that (K p K v - A'/ ) > 0 which automatically guarantees the 
existence of D in Equation 5.44. In the above explicit solutions, P is a linear 
function of Q, for a given A\ this relationship allows a direct regulation of Q 
values in order to affect the structure of P. For example, in the orthogonal 
projection method, in order to reduce the » ? i and r, 2 defined in Equation 5.34, 
small Q u Q 2> and Q 3 can be employed to produce small P 2 , P 4t and P 5 ac- 
cording to Equation 5.43 results. Application of the above explicit P will be 
demonstrated later in example simulations. 


5.6 Modified Controller Design 

In the orthogonal projection method, the control law requires the 

computation of Hi, flj, Hi, Si"'. ttnd wllich creates bur<ten °“ 

time operation. Also the controller is limited to compliant systems with 
To remove such restrictions, new control algorithms are proposed 
in this section. The system dynamics in Equation 5.11 are given here again 


as 


e 


Ai 

C 


u — 


A\ 

C 


h + 


C r 

M 


(/ 2 + A P) 


Now, the composite input u is defined as 


= f, - 4- A7 l ui + C m uo + ua 


(5.45) 


(5.4G) 


where /, represents the feedforward component, u, and ti, are the ideal ac- 
celerations given in Equation 5.5, and «, will be defined in stability analysis. 
Since A, has full rank, its inverse exists and is introduced in the above equa- 
tion. The („, x n,,)- matrix C* in Equation 5.46 represents a general matrix 
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whose exact structure is case dependent and will be discussed below. Substi- 
tuting the composite u into Equation 5.45 results in the familiar form 


where 




A x 

C 


«3 + 7 


(5.47) 


0 


A { C*u-i 


' C T 



(CC* - 1> 2 

+ 

CAT'ui 


. ^ . 

(/» + W) 

(5.48) 


and T 6 7l n0 Xn /> is an identity matrix. Depending on the dimension of C, 
different C" could be selected to simplify the structure of 7. Since C is an 
(»/? x n 0 ) matrix, when n 0 > n p , i.e. , the number of modeled vibratory modes 
is not greater than the number of inputs, and C has a row rank of n p and no 
inaccessible vibratory mode occurs, then the right-inverse of C, C+, exists. 
Hence C* is selected as C * = C + , this selection causes the 7 expression in 
Equation 5.48 to become 


7 = 


AiC+u-i ' 


' C r ' 

CA?u x 


a 2 


(f-2 + A'/?) 


(5.49) 


Otherwise, when the right-inverse C + does not exit due to inaccessibility 
problems or n p > n e , or the computation of C + requires an unacceptable 
overhead in controller implementation, a simple way to reduce 7 is to select 
a null matrix C * = 0 so that 7 becomes 


7 = 


0 


■ C T ■ 

C — iz 2 


_a 2 _ 


(/ 2 + Kft) 


(5.50) 


Both simplified 7 structures will be used in the later example studies. How- 
ever, despite various possible 7 forms introduced above, the controller will be 
designed for the general form in Equation 5.47. Following the error-state def- 
initions in Equation 5.21 and the stable matrix formulation in Equation 5.26, 
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the error-driven system dynamic equations for Equation 5.47 are expressed 

by t\ a 1 \ 

e = Ae + B y ^ «3 + 7j ( 5 - 51 ^ 

where the control component u 3 becomes input of the error-driven system. 
Again, the Lyapunov function candidate V is selected in a quadratic form 

V = e T Pe G 7 7 1 (5.52) 

whose time derivative together with Equation 5.51 yields 

V = -e T Qe + 2e T PB ^ ^ u 3 + 7^ ( 5 53 ^ 

where P and Q are 3(n* + n„) x 3(», + n 0 ) positive definite matrices and 

A t P + PA = -Q (5-54) 

Although there arc many possible selections of u 3 to cause V < 0 for all e ^ 0, 
here « 3 is selected to generate V = -e T Qc. That is, letting tj and ,i denote 
the following quantities 

,, = (A[ c T ]B T Pc e n n ° 

H = JPB-yen 1 (5-55) 

u 3 is solved from the scalar' equation 

,, T u 3 + t i = 0 (5-56) 

Since u 3 is an n, vector, the above scalar' equation is a redundant problem 
hence more than one solution exist. Therefore additional criterion could be 
introduced to assist the selection of u 3 . Two such criteria are presented here. 
First, Equation 5.47 is restated as follows 
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Since the first term in the right-hand side is the desired acceleration, by 
minimizing the disturbance caused by the last two terms, the acceleration 
response will have the best approximation to the ideal result. Hence, the 
problem becomes finding an optimal u 3 that minimizes 

A, 1 II 

C + ^ (5.57) 


while u 3 is subject to the constraint of Equation 5.5G. The optimal solution 
to this problem is given by 


u 3 = -Z I [/if C T \ 7 + 


li-,, T Z[ATC T ) 7 

n T Zi] 


"} 


(5.58) 


where 


Z = 



A x 

C 



(5.59) 


Due to the full rank of Aj, Z is positive definite and hence nonsingular. 
Apparently, u 3 in this design demands some computational effort which makes 
it unattractive foi leal-time implementation. Therefore, another criterion is 
proposed, whose result will be used in the following example studies. Now, the 
object is to minimize ||u 3 || which is subject to the Equation 5.5G constraint, 
and the solution is simply given by 


u 3 = - 



(5. GO) 


where ?/ is assumed to be nonzero. The situations when a null vector 7 / occurs 
for c ^ 0 will be discussed later. For the designed u 3 values, V > 0 and V < 0 
hold for every e ^ 0 , which means that asymptotic stability of error state is 
ensured and consequently tracking of desired trajectories and elimination of 
oscillations are obtained since the error states are defined as the difference 
between plant and reference values. Notice that the modified control algo- 
rithms have much simpler structures than that of the orthogonal projection 
method, therefore, the former control laws demand less computational effort. 
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5.7 Effect of Matrix P on System Response 


In the orthogonal projection method, a P matrix with relatively 
small magnitude entries is suggested to improve system stability. Here, the 
effect of P on controller performance will be analyzed. To investigate sys- 
tem response, the U3 designed in Equation 5.60 is substituted back to Equa- 
tion 5.47 which results in a compact form 


with 


[?' 


«i 



. u2 


+ {T - S) 7 


(5.61) 


5 

v 

R 


= 

= D T Pe 

= \A* C T ] T [AJ C T ] 


(5.62) 


where 7 is defined in Equation 5.48 and I is an (n® -f np) x (n$ + np) iden- 
tity matrix. Note that S is idempotent; that is, S 2 = S, and (I — 5) is also 
idcmpotent. However, since S is not a symmetric matrix, (I — 5) is not a 
projection matrix. Another property is that v T is a left nullvector of (J - 5), 
i.e., v T (I — S ) = 0, which is a result of Equation 5.56. In Equation 5.61, 
when (T- 5) 7 approaches to zero, the controlled system approaches the ideal 
acceleration. According to Equation 5.62, P is a constituent of 5, so the 
selection of P can affect the value of (I - S)r, hence, improve system motion 
response. Furthermore, recalling the definition of B as B = [0 I 0] T , v in 
Equation 5.62 takes on the form v = Piei + P 4 e 2 + P 5^3, which indicates 
that only P 2 , P4, and P 5 submatrices are involved in the computation of v, 
therefore, only these submatrices need to be monitored to affect S and hence 
control response. Once the preferable P 2 , P4, and P5 structures are decided, 
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they could be generated by adjusting the Q u Q 2 , and Q 3 submatrices defined 
in Equation 5.43. Unfortunately, the nonlinear nature of Equation 5.62 hin- 
ders the effort of finding a constant P matrix analytically that minimizes the 
disturbance (I - S)j. However, according to our case study results, a large 
difference between the first n$ and the next np diagonal elements in P 2 , Pi , 
and P 5 submatrices will enhance controller performance. This characteristic 
behavior will be demonstrated later in the case studies, but an explanation is 
given here. Since the v in Equation 5.62 is defined as v — P 2 e. x -f P 4 e 2 -f P 5 e 3 , 
the first ng diagonal elements of submatrices P 2 , Pj, and P 5 are the gains of 
nominal state errors in e u e 2 , and e 3 , while the next np diagonal (dements 
arc the gains of vibratory state errors. A large difference between these gain 
elements will emphasize the errors of nominal states but suppress the effect 
of vibratory state errors. Since the nominal states are smooth and compar- 
atively slow-moving in contrast to the high frequency oscillations, the large 
difference arrangement on the P submatrices will reduce the high frequency 
vibrational disturbance on S and consequently produce a better system re- 
sponse. 

5.8 Effect of Matrix P on System Stability 

One assumption used in the above derivation of Lyapunov stability 
is that ?/ is not a null vector for all e ^ 0. If 7 / = 0 for some e ^ 0 then by 
Equations 5.53 and 5.55 the asymptotical stability is uncertain when 

2 /i > e T Qe > 0 (5.63) 

To choose a matrix P to improve the stability region, the structure of 7/ will 
be analyzed from the inverse identity defined in Equation 4.7 which gives C 
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as 


C = -A^E (Ax - E^E) 


= -A^EAx ( 5 - 64 ) 

A substitution of the above C expression into the rj defined in Equation 5.55 
results in 


n = [A[ C T ]B T Pe = [Aj (— A[E t AJ t )]v 
= A[[I(- E T Aj r )]v 


(5.65) 


where J is an (n, X n,) identity matrix. In the above equation, Ax is a non- 
singular matrix, and [Z(-E T A 2 - T )] € which has a nullity of n 0 . 

Therefore, r? becomes zero when t; is in the null space of [Z(-E T Aj T )]. How- 
ever, due to the geometric dependence of A 2 and E on 6 and /?, identification 
of this null space is a demanding task especially for a moving manipulator. 
Hence, a qualitative analysis is given to this problem. As the submatrices 
of a generalized inertia matrix, S and A 2 generally have a similar order of 
magnitude, therefore, the submatrix (-E T A 2 T ) has entries with a small or- 
der of magnitude perhaps around 1, which means that [1 (— E T A 2 )] could 
be roughly represented by 


’ 1 ... 0 ±1 ±1 

0 ... 1 ±1 ±1 


(5.66) 


so when the entries of (n e +n p )- vector v has a large difference between the first 
n e and the last n 0 elements, t> will be away from the null space of [T(-E t A 2 t )] 
hence [Z(-E T A 2 T )]v / 0, which further implies that q / 0 for all e ± 0. This 
result supports the assumption used in the stability analysis. Recalling that 
v _ p 2ei 4 . p 4 e 2 -f P 5 e 3 , in order to create a v with a large difference between 
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the first n e and the last iip elements, P 2 , P 4 , and P 5 could be constructed with 
a relatively large difference between the first n e and the next n 0 diagonal ele- 
ments. This provides us a guide on the selection of P values. Coincidentally, 
such P structures are also suggested to enhance the controller performance in 
the last section. Of course, the above analyses only give a qualitative solution 
to avoid a null i] which is also affected by the on-line error-state values. 


5.9 Numerical Simulations on a Six-Link Manipulator 

In order to test controller performance, numerical simulations are 
conducted on three flexible manipulators which have the same kinematic 
structure but different compliant components. All three cases use the model 
of a six-degree-of-freedom Cincinnati Milacron T3-776 industrial robot shown 
in Figure 5.1. The first example considers six joint compliances of the robot, 
the second and the third models contain three compliant joints and two flex- 
ible links. The compliant joints modeled in the second example are the first 
three joints, also the forearm and upper arm are considered flexible whose 
lateral deflections are approximated by two orthogonal translational springs 
located at the end of each link. To test the generality of the proposed con- 
troller, a third example is added to the case studies. The third model has 
the same number of vibratory modes as the second example except that the 
wrist is compliant instead of the first three joints. Figure 5.2 shows the spring 
model depicting the joint compliance modeled in the simulations. Figure 5.3 
presents the orthogonal linear springs used in approximating the lateral de- 
flections of each flexible link. The spring stiffnesses used in the case studies 
are arbitrarily chosen for illustration purposes, however, they are approxi- 
mately 2 to 5 times softer than the actual values measured by [Sklar, 1988] 
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Figure 5.2: Joint Compliance Model 



Figure 5.3: Lumped Link Compliance Model 
of Upper Arm end Forearm 
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and [Behi, 1985]. The system parameters of the T3-776 robot are listed in 
the following tables. 


Table 5.1 T3-776 Kinematic Parameters 


Link Length (m) 
(x, y, z) 

Center of Mass (to) 

(x, y, z) 

Offset 
Angle (deg) 

Link 1 


(0, 0, -0.4318) 

0 

Link 2 

(1.1776, 0, 0) 

(0.508, -0.0254, 0) 

90 

Link 3 

(0, 0 , 0) 

(0.1016, -0.1778, 0) 

0 

Link 4 

(0, 0, 1.397) 

(0, 0, -0.508) 

90 

Link 5 

(0, 0 , 0) 

(0, 0 , 0) 

-60 

Link 6 

(0, 0, 0.1524) 

(0, 0, -0.1016) 

60 

Payload 


(0, 0, 0.0254) 



Table 5.2 T3-776 Inertial Parameters 


Mass 

(%) 

Moment of Inertia ( kg.m 2 ) 
(/rx? Xw) 

Link 1 

317.5 

(0, 0, 29.3) 

Link 2 

680.4 

(5.9, 52.7, 43.9) 

Link 3 

453.6 

(49.7, 7.61, 49.7) 

Link 4 

68 


Link 5 

36.3 

(0.23, 0.23, 0.06) 

Link 6 

27.2 

(0.12, 0.12, 0.06) 

Payload 

91. 

(0.06, 0.06, 0.06) 


Table 5.3 T3-776 Actuator Parameters 

Joint 

1 

2 

3 

4 

5 

6 

Inertia (10 -3 • kg • m 2 ) 

4.2 

EH 

2.1 

1.3 

1.3 

0.8 

Damping ( N • mf(rad/s )) 

0.4 

0.4 

0.3 

0.4 

0.3 

0.3 

Resistance (ohm) 

0.8 

0.8 

0.8 

0.8 

0.8 

0.8 

Torque Constant ( volt / (rad / s )) 

20 

20 

14 

11 

8 

8 

Gear ratio 

100 

100 

100 

80 

30 

10 

Back emf Const. (N • m/amp) 

0.5 

0.5 

0.4 

0.3 

0.3 

0.2 


In these case studies, the numerical integration step is selected as 0.1 msec, 
a larger step has been attempted but was abandoned due to numerical insta- 
bility. 
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5.9.1 Case 1: Six Compliant Joints 

Figure 5.4 illustrates the six-link robot used in the first example 
where denote local joint deflections. In this example, each joint 

compliance is represented by a constant torsional spring acting across the joint 
as sketched m Figure 5.2. Torsional springs used in this example are assumed 
massless, therefore, each nominal joint d, and the accompanying vibratory 
mode i £ {1,2, • • • ,6}, is subjected to the same structural inertial effect. 
This means that the submatrices of the generalized inertia in Equations 3.48 
have the same values, that is, 

A 2 = £ = E T = a; (5.67) 

Substitution of this particular property and A! = AJ + / into the inverse 
identity cited below 

' Aj C T ' 

CA 2 

= (Ai -E^A^E) -1 - (Ai - E^E )" 1 E^AJ 1 

. A 2 ^E (a, - ErA^E)" 1 Aj 1 + A^E (Ax - S^E)" 1 E^Aj 1 

produces 


= ~C T = ~C=J~ 1 

A 2 = (Ai)” 1 + J- 1 


where J is the diagonal actuator inertia matrix defined in Equation 3.56 and 
whose values are given in Table 5.3. Since in this case n e = rx 0 = 6 and 
joint oscillations always remain accessible as discussed in the last chapter, 
the right-inverse of C exists and is simply given by C + = -J. The structure 
of 7 in Equation 5.49 here becomes 


7 = 


-u 2 


-J- 1 1 

-Ul 


1 

+ 

1 


(/2 + A7?) 


(5.68) 
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The resultant control input in Equation 5.46 takes on the following expression 

u = fi + Jui - Ju 2 + u 3 (5.69) 

where u, and u 2 are the ideal accelerations given in Equation 5.5, and the u 3 
defined in Equation 5.60 is used in the above controller. The above results 
are valid for any n-link robot modeled with n compliant joints. Notice form 
Equation 5.67 that without adding the actuator inertia J the generalized 
inertial matrix defined in Equation 3.48 is positive semidefinite in this model. 

For illustration purposes, the stiffness matrix for the six compliant 
joints axe chosen as 

K = diag [452000 339000 226000 (8500) 3 ] Nm/rad 

where (■)> represents a diagonal entry repeating consecutively j times, and the 
six diagonal elements correspond to the stiffness values of joints 1 through 6. 
In this example, eigenvalues (-3 - 6 - 7) are assigned to the ideal nominal and 
vibratory mode accelerations, which produce diagonal feedback gain matrices 

K p = K-81)i 2 ] K v = [(— 16)i 2 ] K t = E(126) 12 ] 

where the first six diagonal elements are associated with nominal motion 
and the last six diagonal elements axe with vibrational modes. The robot is 
controlled to follow nominal trajectories defined by 

= A 9f(t,t f ) + e r0 

= 6— -15^ + loi- (5 70) 

where f(t, t s ) is a normalized fifth-order polynomial with /( 0, tj) = /( 0 , tj) = 
f(0,t f ) = ) = f(t h t s ) = 0 and = 1 , in which t f is the 
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termination time for reference motion. In the above equation, A 0 is the 
amount of joint movement, and 0 tO is the star ting position of reference trace. 
The reference trajectory is chosen to have smooth start and stops in order 
to avoid shocks that might trigger structural resonance. In the simulation, 
actual joints will start from a position 9 0 distinct from the desired initial 
0 rO . This difference is deliberately created to test the tracking capability of 
the designed controller. The trajectory parameters used in this example are 
tabulated in the next table. 


Table 5.4 Case 1 Nominal Trajectory Parameters 


tj(sec) 

A6(deg) 

9 t 0 

*0 

1 

O 

Joint 1 

8 

50 

0 

-10 

-10 

joint 2 

8 

40 

35 

30 

-5 

Joint 3 

8 

-40 

-55 

-45 

10 

Joint 4 

8 

40 

0 

-5 

-5 

Joint 5 

8 

50 

0 

-5 

-5 

Joint 6 

8 

20 

0 

-5 

-5 


Besides the initial position errors, a discrepancy in payload description is 
deliberately introduced to test robustness of the controller to parameter vari- 
ations. The controller presumes a payload of 68 kg while the system actually 
carries a 91 kg payload which represents a 30 % error. 

In order to avoid a null rj vector for c / 0 as discussed in the 
previous section, P needs to have a relatively high difference between the 
part associated with nominal joints and vibrational modes. Accordingly, the 
Q values selected for this case axe 

Qi = [(lOOOOO)e (200) 6 ] Q 2 = [(1000) 6 (2) 6 ] Qz = [(100000) 6 (100) 6 ] 

and for the above given feedback gain matrices this selection generates sig- 
nificantly different P values for nominal and vibratory modes, which are 

Pi = [(19499)6 (37.57) 6 ] P 2 = [(824.4) 6 (1.56) 6 ] P 3 = [(— 16779) e (— 26.52) e ] 

P 4 = [(82.78)6 (.16)e] P 5 = [(-396.8) 6 (-.40) 6 ] P 6 = [(136022) 6 (299) 6 ] 
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For these selected parameters, a simulation is conducted and the results are 
displayed in the following figures. Figures 5.5(a) to 5.5(f) give the actual 
and reference joint displacements. Note that an initial error separates these 
two traces in each figure. Figures 5.5(g) to 5.5(1) display the joint deflections 
of the controlled system, while Figures 5.5(m) to 5.5(r) show input voltages 
for each actuator. These results indicate that nominal displacements show 
asymptotically stable path tracking capability while residual vibrations set- 
tle to static deflection values. In Figure 5.5(n), the high voltage surge at 
the starting point is due to the sudden release of the system, which might 
physically exceed actuator saturation voltage values. In order to study this 
problem, the same simulation is repeated with a ±50 volt bound on each 
actuator. The results are presented in Figures 5.6(a) to 5.6(r). A comparison 
of both simulation results suggests that the system response remains almost 
identical, which implies that for this simulation, controller performance is 
not sensitive to voltage saturation. Note that in Figures 5.5(m) to 5.5(r) 
and Figures 5.6(m) to 5.6(r) the high frequency, small magnitude vibrations 
in control voltages at steady state are to counteract spring torques due to 
residual oscillations which are considerably small as shown in Figures 5.5(g) 
to 5.5(1) and Figures 5.6(g) to 5.6(1). Actually, such residual oscillations 
will quite possibly be dissipated by structural damping not included in the 
dynamic model. 




Figure 5.5: Six-Compliant-Joint Model Simulation Results 
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Figure 5.6: Six-Compliant-Joint Model Simulation Results 
(With Voltage Bound) 
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Figure 5.6: Six-Compliant-Joint Model Simulation Results 
(With Voltage Bound) 
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5.9.2 Case 2: Three Joint and Four Link Compliances 

Figure 5.7 shows the model of the second example manipulator 
whose first three joints axe compliant and modeled by the torsional spring 
depicted in Figure 5.2. Besides the joint compliances, the forearm and upper 
arm are modeled as flexible links whose flexibilities are approximated by or- 
thogonal springs shown in Figure 5.3. Therefore, seven vibratory modes are 
modeled in this example, which are denoted by ■ ,Pr separately as indi- 

cated in Figure 5.7. Since n p > n e in this example, the 7 structure defined in 
Equation 5.50 is employed to construct the control command. The stiffness 
matrix values for this case are assigned as 


K = diag[452000 339000 226000 ; (3500000) 4 ] Nm/rad ; N/m 


where the same stiffness value is assigned to all translational springs. The first 
three joint stiffnesses axe in Nm/rad, while the last four are link stiffnesses in 
N /m. The reference trajectories used in the last example are used again in this 
simulation. Similar payload error is also tested here. In order to emphasize 
nominal motion tracking, the eigenvalues for all nominal joint displacements 
are assigned to (-3 - 4 - 5), and to (-1 - 2 - 3) for all vibratory modes. 
The corresponding diagonal feedback gain matrices are given by 


K p = [(—47)6 (-ll)?] K v = [( — 12) e (- 6 ) 7 ] Ki = [(60) 6 ( 6 ) 7 ] 


where the first six diagonal elements are the feedback gains associated with 
nominal motion, and the last seven diagonal elements are that of vibratory 
modes. The Q and P submatrices used in this case axe 


Qi = [(10000)6(1)7] 
Pi = [(19380)6 (2)7] 
P 4 = [(262.9)e (-ll)?] 


Q 2 = [(5000) 6 (1)7] Qs = [(100000) 6 (1) 7 ] 

P 2 = [(654.8)e (.15)7] Pa = [(-25774)e (-1.15) 7 ] 

P 5 = [(-833.3)6 (-.08)7] Pe = [(78452)6 (1.82) 7 ] 
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which have a large difference between the first six and the last seven diago- 
nal elements to avoid a null r). The simulation results are displayed in the 
following figures. Figures 5.8(a) to 5.8(f) are the nominal displacements of 
joints 1 to 6. Notice that each joint starts with a positional error away from 
the reference trajectory. Figures 5.8(g) to 5.8(m) show the vibratory mode 
deflections along the actual trajectory. Figures 5.8(n) to 5.8(s) display the 
implemented voltages produced by the designed controller. Because of the 
emphasis on precise nominal tracking by choosing advantageous eigenvalues 
and P matrix, the nominal displacements converges satisfactorily to the de- 
sired trajectories even under initial position error and inaccurate payload 
information. In Figures 5.8(j) to 5.8(m), the link oscillations are bounded by 
decaying envelopes around the trace of static deflection. It is noticed that all 
vibratory modes are stabilized to negligible residual oscillations at the end 
of motion. The nonzero, steady state static deflections in Figures 5.8(h), (i), 
(j), and (1) are due to gravitational loading. 

In order to test robustness of the proposed controller, a 30 % payload 
error was created in the above simulations. To constrict the test conditions, 
the payload error is further increased in this simulation. Now, the controller 
constructs control voltage for a 68 Kg payload while carrying an actual pay- 
load of 227 Kg which is more than three times of the assumed value. With 
this new payload change, the last simulation presented above is repeated and 
the results are shown in Figures 5.9(a) to (s). It appears that stability is 
maintained in this case but joint 1, 2, and 3 displacements in Figures 5.9(a) 
to (c) are affected by the large payload difference. This phenomenon could 
be explained from a comparison of the new payload error (159 Kg) with the 
system parameters listed in Table 5.2. Since the error is of the same order 
of magnitude as the mass of links 1, 2, and 3, it creates an impact on the 



1G5 


motion of the first three joints. Notice that the wrist motion shown in Fig- 
ures 5.9(d) to (f) is seldom affected by the payload error in this case. That is 
because the wrist motion is affected primarily by the moment of inertia of a 
given payload. In this example, mass is the only payload error and due to a 
short moment arm between the gripper and the wrist, payload error creates 
little disturbance on wrist control. The effect of payload uncertainty on wrist 
motion control will be presented in the next chapter. 
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Joint 1 Displacement (deg) 
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Figure 5.8: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (30£ Payload Error) 
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Figure 5.8: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (30% Payload Error) 
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Figure 5.8: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (30% Payload Error) 
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Figure 5.8: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (30% Payload Error) 
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Figure 5.8: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (30£ Payload Error) 
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Figure 5.8: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (30% Payload Error) 
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Figure 5.8: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (30% Payload Error) 
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Figure 5.9: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, end Forearm 
Compliances (Large Payload Error) 
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Figure 5.9: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (Large Payload Error) 
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Figure 5.9: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (Large Payload Error) 
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Figure 5.9: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (Large Payload Error) 
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Figure 5.9: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (Large Payload Error) 
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Figure 5.9: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (Large Payload Error) 
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Figure 5.9: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (Large Payload Error) 
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Figure 5.9: Simulation Results of the Six-Link Robot Modeled 
with First Three Joint, Upper Arm, and Forearm 
Compliances (Large Payload Error) 
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5.9.3 Case 3: A Compliant Wrist and Four Link Compliances 

In the T3-776 robot shown in Figure 5.1, the forearm is designed as a 
lever rotating around the third joint, or elbow. The wrist and wrist actuators 
are located at opposite ends of the forearm. This kinematic arrangement 
has the benefit of using wrist actuators to counterbalance the inertia of wrist 
and forearm. Inside the forearm, three slender, coaxial torsion tubes serve as 
driving shafts connecting the wrist to its actuators as shown in Figure 5.10. 
Due to the slenderness of the torsion tubes, the wrist is softer than the first 
three joints. The third example will model the torsion tube stiffnesses by 
three torsional springs and also include the forearm and upper arm flexibility 
in controller design. The example model is sketched in Figure 5.11, where 
the first three joints are rigid and fli, - • ■ ,fl 7 are the modeled joint and link 
vibratory displacements. In this example, the influence of P values on system 
response as mentioned in the previous section will be demonstrated. The 
stiffness matrix is selected as 

K = diag[(8500) 3 ; (3500000) 4 ] Nm/rad ; N/m 

where the first three values are wrist joint stiffness in Nm/rad and the last four 

values are lateral link stiffnesses in N /m. Similarly, the robot is controlled to 

follow the reference trajectories specified in the last example under the same 

initial position and 30 % payload errors. First, the same set of eigenvalues, 

feedback gain matrices, and P and Q matrices used in the last section are 

repeated in this case, which are 

K p = [(-47) 6 (-II)t] K v = [(-12) 6 (-6)7] Ki = [(60)6 (6)7] 

Qi = [(10000) 6 (1)7] Q 2 = [(5000)e (1) T J Qs = [(100000) 6 (l) r ] 

P x = [(19380)6 (2)7] P 2 = [(654.8)6 (.15) 7 ] P 3 = [(-25774) 6 (-1.15) 7 ] 

P 4 = [(262.9)6 (.11)7] P 5 = [(-833.3)6 (— .08)r] Pe = [(78452) 6 (1.82) 7 j 
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The simulation results are displayed in Figures 5.12(a) to 5.12(a) whirl, show 
satisfactory performance as expected. Now, for comparison purposes, the 
last seven diagonal elements of ft, ft, and ft submatrices are increased 100 


times to 


ft [(10000)e (100) 7 J ft- ((5000) 6 (100) 7 j ft = [(100000) e (100) 7 J 

according to the linear relationship between P and ft the P submatrices 
then altered to 


Pi = [(19380)6 (200)7] 
p 4 = [(262.9)6 (10.83) 7 ] 


P 2 = [(654. 8) 6 ( 15 ) 7 ] 

P 5 = [(— 833.3)e (- 8 . 33 ) 7 ] 


p 3 = [(-25774) 6 (-115) 7 ] 
p 6 = [(78452) 6 (181. 67) 7 ] 


This adjustment increases the last seven entries by a factor of 100 and reduces 
the difference between the nominal and vibratory mode portions in P. Simu- 
lation of the third model is repeated for the new P values and the results are 
Plotted in Figures 5.13(a) to 5.13(s). The system response deteriorates dras- 
tically although the stability is maintained for the new P. This comparison 
shows that a proper selection of P values can signiHcantly enhance controller 
performance. For example, in this case a large difference between the nominal 
and vibrational entries in P is preferable according to the previous successful 
examples. An analytical explanation for such results was presented in the 
previous section regarding the effect of the P matrix on system response. 
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Figure 5.12: Simulation Results of the Six-Link Robot Modeled 
with Wrist, Upper Arm, and Forearm Compliances 
(Appropriate P Matrix) 






192 


Joint 5 Displacement (deg) 



Joint 6 Displacement (deg) 



Figure 5.12: Simulation Results of the Six-Link Robot Modeled 
with Wrist, Upper Arm, and Forearm Compliances 
(Appropriate P Matrix) 
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Figure 5.12: Simulation Results of the Six-Link Robot Modeled 
with Wrist, Upper Arm, and Forearm Compliances 
(Appropriate P Matrix) 





195 


Link 2 Deflection (Beta 5) 


ll *41 


15.01 
T i me < sec > 


Link 3 Deflection (Beta 6) (mm) 


15 .01 

T i me (sec) 


Figure 5.12: Simulation Results of the Six-Link Robot Modeled 
with Wrist, Upper Arm, and Forearm Compliances 
(Appropriate P Matrix) 




196 


Link 3 Deflection (Beta 7) (mm) 



( m > 


Rctuator Uoltage 1 <v> 



Figure 5.12: Simulation Results of the Six-Link Robot Modeled 
with Wrist, Upper Arm, and Forearm Compliances 
(Appropriate P Matrix) 














199 


Actuator Uoltage 6 <y> 


1 .12 

D.S7 










O.BZ 










D .17 










0.53 

1 









0 .31 

L_ 









0.23 

BLi 

— 4- 








0.01 


* 





0 .07 

w*nr 




D - ,M 1 • si 3 - 3H 5 B1 B.BB B.3H 10 .01 11 .SI 13. m is jjl 

/«. n Time (sec ) 


Figure 5.12: Simulation Results of the Six-Link Robot Modeled 
with Wrist, Upper Arm, and Forearm Compliances 
(Appropriate P Matrix) 




200 


Joint 1 Displacement (deg) 



Joint 2 Displacement (deg) 



Figure 5.13: Simulation Results of the Six-Link Robot Modeled 
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5.10 Summary 

In this chapter, various controllers are presented to control compli- 
ant manipulators whose system parameters are assumed to be known a priori. 
First, the difficulty of ideal acceleration assignment is analyzed, which could 
be considered as solving an overdetermined problem. Due to the dimensional 
mismatch between the available number of actuators and the modeled de- 
grees of freedom, solution of a given overdetermined problem is not ensured. 
Therefore, Lyapunov’s stability criterion is employed to assist controller de- 
sign. Since Lyapunov stability is defined in 7 Z 1 space, control design even- 
tually becomes a redundant problem where multiple selections for control 
structure exist. Then, the orthogonal projection method is used to construct 
the first proposed control algorithm. However, this method is applicable only 
to systems with n $ > n 0 . Therefore, modified algorithms are presented which 
demand less computational effort than the orthogonal projection method. In 
the designed controllers, the effects of the P matrix on system stability and 
system performance are discussed. To obtain a desirable P structure, an ex- 
plicit Lyapunov matrix solution is presented, which allows direct adjustment 
of the P matrix structure through regulation of Q matrix values. Three case 
studies of the modified control algorithms are conducted on a compliant six- 
link robot. The first case models the robot with six joint compliance. In 
this case, the controller is further simplified after exploiting the inverse iden- 
tity of the generalized inertia matrix. Voltage saturation effect is also tested 
in the first case. The second example uses lumped parameters to model 
the first three joint compliances and the forearm and upper arm flexibilities. 
Controller robustness is examined by a large payload uncertainty. Finally, 
generality of the proposed controller is demonstrated through the third ex- 
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ample which is a six-link robot with a compliant wrist and two flexible links. 

Seven lumped springs are used to model structural flexibility. The influence 

of P matrix values on controller performance is also investigated in the third 
example. 



Chapter 6 


Adaptive Control of Compliant Robotic Manipulators 


In the last chapter, the controllers for compliant manipulators are 
constructed based on well-known system and payload parameters. The ro- 
bustness of these controllers are illustrated in computer simulations through 
a payload uncertainty which represents a discrepancy between actual system 
and mathematic model. The simulation results show a reliable stability on 
motion control under the presence of payload uncertainty. However, con- 
troller performance degrades as the uncertainty becomes considerably large, 
as shown in the second example of the last chapter where payload error is 
twice of the assumed value. Generally, for routine operations, the payload 
range could be estimated from a given task. Therefore, a conservative ap- 
proach could be to choose the average payload value as the working object 
of controller. Yet, a controller designed in this manner becomes inefficient 
when payload varies significantly. Therefore, when the information on wprk- 
ing objects is not known precisely or if it varies significantly, such as in mining 
or undersea exploration applications, it will be desirable and very effective 
to have controller adaptively adjust the commands to meet the uncertainty 
and additionally provide information about the payload. Such adaptive con- 
trollers not only provide robots with a sense of intelligence but also assist 
human operators to identify the working object. Being motivated by this 
practical as well as challenging objective, an adaptive control law for compli- 
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ant manipulators is developed and tested in this chapter. 

Presentation of the adaptive controller will proceed in six sections. 
The first section shows two methods of expressing manipulator dynamics in 
a linear form in structural and payload inertial parameters which include 
mass, center of mass location, and moment of inertia of each constituent link 
and payload. By considering these inertial parameters as to be determined, 
the second section introduces, for this linear system, a continuous-time stan- 
dard least-squared estimation technique modified with exponential forgetting 
factor. From the first two section results, an adaptive controller algorithm 
achieving both motion control and on-line uncertain parameter estimation 
is developed in the third section. The fourth section will test the proposed 
controller through case studies. In the fifth section, update delay effect on 
the adaptive controller performance is analyzed. Suggestions are given to re- 
duce the impact of update delay on the controlled system response. The final 

section will make comparisons between adaptive and non-adaptive control 
algorithms by example studies. 


6.1 Dynamic Formulation of Explicit Linear System 
Parameters 

It is important to have a precise dynamic description to build an 
efficient controller. In robotic manipulators, dynamic equations are formu- 
lated in terms of the generalized coordinates and inertial properties. The 
former could be measured on-line by attached transducers such as tachome- 
ters, potentiometers, and strain gauges; the latter (inertial parameters) are 
composed mainly of the link length, mass, location of center of mass, and 
moment of inertia of each link including the payload. These inertial parame- 
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ters are generally constant for a given robotic manipulator, and manipulator 
inertial magnitudes are obtainable from the robot manufacturer. Yet, it is 
desirable to have occasional on-site calibration especially when manipulator 
is reassembled due to maintenance, transportation, or modularized structure. 
Among these inertial properties, only the link lengths can be measured imme- 
diately from the manipulator. The exact link mass, center of mass location, 
and moment of inertia of a completely assembled manipulator axe difficult to 
calibrate directly, especially after adding the inertia of driving systems. Nev- 
ertheless, it will be shown later that manipulator dynamics could be expressed 
as a linear equation of these not directly measurable inertial quantities so that 
an on-line calibration is possible experimentally. 

In the following sections, robotic dynamic equations will be derived 
by both the Newton-Euler and Lagrange methods. Unlike the dynamic equa- 
tions introduced in the second and third chapters, the final dynamic expres- 
sions are linear in mass, center of mass location, and moment of inertia of 
each modeled link. Since manipulator payload is generally constant and could 
be modeled as a fixed link attached to manipulator gripper, the following 
derivations are general for manipulators with or without payload. Therefore, 
the results could be applied to manipulators in off-line inertial calibration or 
on-line motion control and payload estimation. Structural compliances are 
included in the following analysis, and lumped parameter approximation is 
employed to model manipulator flexibility. 

6.1.1 The Newton-Euler Method 

The Newton-Euler method of deriving manipulator dynamics is to 
find the force and torques acting on each link first, then to project them to 
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the upstream, closer to the base, driving joints. The sum of projected forces 
or torques at each joint give the corresponding actuating force of a prismatic 
actuator or actuating torque of a revolute joint. Without externally applied 
force and torques, the force and torque on each link considered here are due to 
inertial load. It will be shown that these inertial force and torques are linear 
in mass, center of mass location, and moment of inertia of each link. Before 
giving the derivation, it should be noted that the center of mass location and 
moment of inertia of a moving link are constants only with respect to a fixed 

coordinate frame attached to the link. So, in order to distinguish a local 

coordinate description from a global one, a superscript, e.g. /, is added to 
each spatial vector defined in a local coordinate frame fixed in link l. 

Figure 6.1 shows a floating link, /, with a mass m, center of mass 
location r', and moment of inertia whose components are 

Pt Ixy Ixz 

lyx lyy Iyz G 7 £ 3X3 (6-1) 

Izx Izy I Z z 

and due to the symmetry in I xy = /^, /„ = and Iyz = The 
superscript 1 indicates that these parameters are defined by the Ith frame 
and hence constants. It will be shown that the final inertial dynamics are a 
linear function of ten inertial parameters composed by 

m i r n r y, Tz, I xx , J xj/ , I xz , I yy , l yz , J zz 

If we define P l £ 7l 3 as the distance vector between the origins of frame 
l and global frame, and let R‘ e 7 V> be the location of the center of mass 
measured from the global origin, where both vectors are expressed in the 
frame l coordinates, then 

R l = P l + r l 
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Figure 6.1 A Simple Floating Link Model 
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R l = P l + u l xr‘ (6.2) 

R^ = P l -\- lo 1 x r l - f w 1 x (c*/ x r l ) 

where u j l = [u> l x uf l y u>‘ z ] T G R 3 is the angular velocity of link l expressed in 
frame /. In Figure 6.1, the origin of l coordinate frame, point p, is generally 
located along the axis of driving joint of link l or at the center of gripper, if 
link l is a payload. Therefore, once the inertial force and torque are defined 
at p , they can be transferred to the upstream links recursively. 

The inertial force, F 1 G R 3 , at the center of mass of link / is 
F 1 = mil 1 -f- mg 1 

= m(P l + g l ) + w l x mr l -f uj 1 x (iv l x mr l ) (6.3) 

where g l is the vector of gravitational acceleration defined in / frame, and in 
the global frame expression, £ = [00 g] T G R 3 where g is the gravitational 
acceleration constant. The inertial torque, r l G R 3 , at the same point is 

r' = j'a,' + w 'x(/y) ( 6 .4) 

A shift of both vectors to the origin p of l frame produces a force F l p with 
-Fp = F‘ and a torque defined by 

Tp = t 1 + r‘ x F l 

= x (ij-u; 1 ) + r l x m(P l + g l ) 

+ m{r l x [d;' xr'+w'x ( u>‘ x r')]} (6.5) 

The last term in the right-hand side of the above equation is simplified as 
follows. Given three R 3 vectors a, 6, and c, a vector triple product identity 
is defined a s a x (b x c) = (a ■ c)b - (a ■ b)c, hence r‘ x (u< x r‘) becomes 

r l x (u‘ x r l ) = (r l ■ r‘)u‘ - ( r‘ • cb')r' 

= (r‘ -r‘l -r l r‘ T )u l 


(6.6) 
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where I G 7v 3x3 is a unit matrix, and r l i jl is a 3 x 3 dyad. Also, by using 
the identity 

a x [b x (b x a)] - b x [a x (b x a)] = -(a ■ b)(b x a) 

the term r l x [lo 1 x ( u> ' x r 1 )] becomes 

r l x [u> 1 x (a)' x r')] = u>‘ x \r l x (u> 1 x r')] 

= (jj l x (r 1 • r l X — r l r lT )u : l (6-7) 

After collecting (-)w' and u l x (-)w 1 terms separately, r l p has a compact form 
of 

Tp = IpU 1 +u l x Jp co l + mr l x (P l + g ‘ ) (6.8) 

with II defined as 


/' = I l c + m(r l -r l I -r‘r ,T ) 

l xx + m(r 2 y + r\) I xy - mr x r y I xz - mr x r z 

I yx - mr y r x I yy + m(r 2 x + r\) I yz - mr y r z 

Izz + ™( r l + r l) 


Izx - mr z r x 

Ipxx Ipxy -fpxz 
Ipyx Ipyy ^pyz 
Ipzx Ipzy Ipzz 


I zy ~ mr z r y 


(6.9) 


Eventually, the elements of I l p will appear in the final dynamic equations. 
Since I 1 is a constant matrix, I' could be obtained once I l p , r', and m are 
identified. From both force and torque expressions, Equations 6.3 and 6.8. 
it will be shown that the final dynamic equations are linear in ten inertial 

parameters 


First, these ten parameters must be organized from the matrix multiplication 
and vector cross product terms in Equations 6.3 and 6.8. In order to extract 
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these inertial parameter, two simple notations are introduced here. The first 
notation is defined as 


M-] ^ 


I" 0J l U> 1 U) 1 

X y w z 


0 0 


0 

0 


0 0 w l y u l z 

0 u‘ x 0 u> l y u z 


( 6 . 10 ) 


0 0 ll>‘ n ,,i 

and for the cross product of any two TV vectors, A = [a, a 2 a 3 ] T and B = 
[&i b 2 6 3 ] t , the second notation is defined as 

Ax B = 


dl ‘ 


' b, ■ 


— CK 3&2 


X 

b 2 

= 

G3&1 — aib 3 

a 3 _ 


b 3 


aj6 2 — a 2 bi 


0 

a 3 

— °2 Ol 


-03 a 2 
0 — a x 

0 


= [Ax)B 


b i 

b 2 
L *3 J 


( 6 . 11 ) 


Then, by the first notation. 


iy 


*pxx 
Ipyx 
L Ipzx 


L pxy 

^vvy 


pzy 


*-pxz 

Ipyz 


L pzz 



1 


1 


“i J 


U)\ 


Ipxx& x + IpxyWy I) 

. + Ipyy^l + IpyzU>{ 

L hzx^x + Ipzy (A + I VZ2 U>1 


l 1 


= M-J 


*pxx 


L pxy 

Ipxz 


pyy 


pyz 

Ipzz J 


(6.12) 


and according to the second notation, the cross product terms in Equa- 
tions 6.3 and 6.8 could be expressed by 


* x mrl = [w'xj mr l ; x ( w < x mr l ) = [ w 'x][a/'x] 
mr l x (P l + g 1 ) = [—(P 1 4. ff l )x]mr l ■ u,' X iy = [ U ‘ X ]I' U I 


mr * 
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With the assistance of these notations, the force and torque at point p due 
to the inertial force of link l could be expressed as 


r f 1 i 

V 


(P l + g 1 ) [u^x] + [u/xjlu/x] 0 

r l 

L p J 


0 [-(-P' + </0 x ] [w'-J + [u;'x][u>'-] 


= R'i eft 6 * 10 (6.13) 

where a; is the vector which contains ten constant inertial parameters of link 
l which are 


a; 


[oi a,2 • • • aio] T £ TV 0 


[m 7TIT % 711 P y HfXT z I pxi~ ^pxy I pxz f pyy ^pyz ^pzz\ 


(6.14) 


So far, the inertial force and torque, F p and r^, are /-frame vectors, they 
should be converted into the global frame values to compute the correspond- 
ing driving torque or force at each joint. Letting 7} be the 3x3 transformation 
matrix converting / frame coordinates to global frame coordinates, then the 
global coordinates of F l v and r p are simply given by 


r f i 


Ti 

0 ‘ 

[ 3 ] 

. t p . 


0 

T, . 


— 

' T, 
0 

^ O 

R"&i 


def 


R' t a i ; R! l € ft 6x10 


(6.15) 


Since the conversion process is a matrix premultiplication, the linear relation 
with the constant inertial vector a / is maintained in the above expression. 
Equation 6.15 gives the inertial force and torque of the /th link in terms of 
the global coordinates. The corresponding driving input at each upstream 
joint is computed next. In Figure 6.1 a prismatic joint, i, is located at the 
upstream of link /, then the driving force of i to counteract the inertial force 
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and torque at link l is 


F,i = Si ■ F p 

= [sf 0 0 Oji^a, 

= (a,), a, ; (R F )f 6 K'° (6.16) 

where a, is unit directional vector of joint i. Summation of all inertia force 
on i gives the ith joint actuator force as 

N 

Fi - EFu 

/=» 

= YXRf)i*i 

/=t 

— [0 • • • 0 (Rf ) ,■ . . . (i?^)^r]a 
— Rf& ; R/p G 7?. 10 (6.17) 

where N is the number of links including payload and 

a = [afa^ ■ • • a£] r e R} 0N 

Notice that since all links located at the upstream of joint i contribute no 
inertial effect on i, they are excluded from the above force summation. Simi- 
larly, in Figure 6.1, joint / is located at r jt above a revolute joint j, the torque 
on joint j due to the inertia of link l is 


T H = s j ■ (■ rji x F p ) + Sj ■ t p 
= (*j X Tji) ■ F p + S, • Tp 

= [( 5 i * r Ji) T (sj)]#, a/ 

= (RtU ; {R t )J € n™ ( 6 . 18 ) 

where Sj e R? is unit directional vector of joint j. Notice that scalar triple 
product identity a ■ (b x c) = (a x b) ■ c is used in the above derivation. The 
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sum of all inertial torque on joint j is 

N 

1=3 
1=3 

[0 • • • 0 ( Rt ) j ■ ■ • (Rt)n]& 

R t a ; R t t <E n 10 (6.19) 

It should be noticed that the above derivations are applicable to both rigid 
and lumped-compliant manipulator models. In the lumped complaint ma- 
nipulator model, the primary link and joint oscillations axe depicted by the 
movements of pseudo prismatic or revolute joints which are driven by lumped 
springs. By following the lumped model description, joints i and j in Fig- 
ure 6.1 could represent either actual or pseudo joints. For actual joints, 1% 
and Tj axe respectively the actuator driving force and torques. For pseudo 
joints, Fi and r, axe the stored resilient force and torque in lumped springs 
located at joint i and j separately, which are F, = —Kif3, and Tj = —K : {3j, 
where K, and Kj are spring stiffnesses and /?, and (3j are spring deforma- 
tions. Therefore, as shown in Equations 6.17 and 6.19, the inertial dynamics 
of a robotic manipulator, rigid or lumped compliant, could be expressed as 
a linear function of inertial parameters a. Similar dynamic expressions are 
employed by [Sklar, Hudgens, and Tesar, 1990] to perform calibration of rigid 
robot inertial parameters. 

6.1.2 The Lagrange Method 

The first step in the Lagrange method is to find system kinetic and 
potential energy expressions in terms of structural inertia. Let KE\ denote the 
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kinetic energy of link /, then the total kinetic energy of an AMink manipulator, 
including payload, is 

KE=jriiE l 

1=1 

and letting ( P E g ), denote the gravitational potential of link / and ( PE s ) t be 

the potential energy due to structural resilience of /, then the total potential 
energy is 

PE = £ {(PE,), + (PE,),} 

1=1 

Typically, ten constant inertial parameters of link /, which are similar to that 
defined in Equation 6.14, will be grouped from the kinetic and potential en- 
ergy expressions into a linear form. Since the differentiations in the Lagrange 
equation are linear operators, the linear relationship with inertial parameters 
remains intact in the final dynamic equations. Before presenting this deriva- 
tion, a note about the usage of notation is that although kinetic and potential 
energy are scalar physical quantities and independent of the selection of co- 
ordinate frame, the following vectors are defined in global frame except those 
added with a superscript I to emphasize /-frame vectors. 

According to Figure 6.1, 

2 KE, = m(P + r) 2 +u t T 1 I 1 c T 1 t u> 

= mP P + 2 mP T r + mr T r + uj T T l I l c T t T u ) (6.20) 

in which T ; is the 3 x 3 transformation matrix converting / frame into global 
coordinates, and lo € E 3 is the angular velocity of link /. For r = ta x r, the 
(mr T f) term in the above equation could be written as a dyad matrix form 
through the following operations 


. T • 

mr r 


mr * r 
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= m(u) x r) ■ (u> X r) 

= m{u> • [r x (w x r)]} 

= mu> ■ [(r • r)u> — r(r ■ re)] 

= u T [m(r T rJ — rr T )]u 

= u T T l [m(r lT r l I-r l r lT )]T l T u; (6.21) 

where r is transformed into r' by the relation r = T t r l , also the orthogonal 
property of coordinate transformation matrix is used here, i.e., T, J T, = I, and 
j £ 7^,3 x 3 j s a un j t matrix. Then the moment of inertia term in the kinetic 
energy expression could be redefined with respect to the point p in Figure 6.1 
instead of the center of mass as 

mr T r+u T TiI l c l? u = a; T T,[/' + m(r'Vx - r'r ,T )]T J T a; 

= w T T i /jT, T u (6.22) 

where 

/' = /' + m(r lT r l 1 — r'r /T ) 

Because the constant matrix is symmetric, it could be decomposed into six 
matrices 



' 100 ] [0 101 [ 001 ' 

= 0 0 0 Ipxx + 10 0 Ipxy + 0 0 0 Ipxz 

oooj [° 00 J L 100 . 

' 000 ] [ 000 ] [ 000 ' 

+ 0 10 Ipyy + 0 0 1 Ipyz + 0 0 0 I pzz 

oooj [oioj [001. 

10 

d ^ f £l pi a t ; J pt £ft 3x3 


(6.23) 
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where 


[a 5 a 6 a 7 a 8 a 9 a 10 ] = [I pxx I pxy I pxz I pyy I pyz / p „] 

and I pi , i € {5, • • • , 10}, is defined accordingly. By the distributive law of ma- 
trix multiplication, the kinetic energy of moment of inertia could be expressed 
as a linear sum of the above constant a, elements, or 


10 


1=5 

10 

= £(« T nGTTJ^ R G,q) ai 

is 5 
10 

= £(^)a. 


t=5 


(6.24) 


In the above expressions, angular velocity u> is replaced by the joint speed q 
and rotational influence coefficient R G, through the relation io = R G,q, where 
9 P ] £ P- and 0 is an rig vector of actual joint displacements and 

0 is an np vector of modeled pseudo joint variables. Similar replacements will 
be used in the following derivations so that the first and second order influ- 
ence coefficients could be employed to formulate the final dynamic equations. 
Notice that the above I * , with i = 5, • • • , 10, are symmetric matrices. 

Now for the mP T r term in the 2I\Ei expression given by Equa- 
tion 6.20, 


• T 

mP r = mP • (u> x r) 

= mP • [w X (r x x + r y y + r z z)\ 

— —P ■ (i x cj)(mr x ) — P • (y x u>)(mr y ) 
- P ■ (z x u)(mr z ) 


(6.25) 


where x, y, and z are respectively x, y, and z unit directional vectors of / 
frame coordinates. By the influence coefficient definitions iv = R Giq and 
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p = T G p q, the above equation becomes 

2 mP T r = mP T r + (mp T r) T 

= £ g T {-[ tG p • (5 X rG,)] - [ T G p • (5 x RG,)] T K(mr s ) 

(6.26) 


s—x>y,z 

4 


= £(<f^)«. 

i=2 

with [o 2 a 3 o 4 ] = [mr x mr y mr z ], and I 2 *, I 3 ’, and / 4 * are symmetric matrices. 
In the above equation, since R G\ is a 3 x (n# + n^) matrix, the cross product 
s x rGi means cross product of s with respect to each 'll 3 column of rG;, 

which is defined in the followings. Set q = [q x q 2 • • * 9„ e + n ^] T ancl ~ 

[ci c 2 • • ■ c ne+n J, where c, € H 3 , i <E {1, • • • , n B + n 0 }, is column vector of rG,, 

then 

(6.27) 


rGi<? = £ 
i=i 


and 


ne+n/? 

S x ( R G t q) = £ (5 x c,)4i 

t=l 

= [(J X Cj) (s X c 2 ) ■ ■ ■ (5 x c„ e4 . n ^)] 5 

= f s x R Giq 


(6.28) 


Finally, by defining a x = m, the linear term of oj in 2A'£), Equa- 
tion 6.20, is simply 


mP P = m(q T T G p tG p <z) 


and I* = (I*) T . A collection of the above expressions gives 

10 

2KEi = £(5 T /*g)a, 

= [(? r fT«) (9 T/ 2?) • • • (9 Tj io 9)]/ a ' 

d = [9 T /*9]/a, 


(6.29) 


(6.30) 
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where € with (fl-g) as the jth element. By stacking up the 

constant inertial parameters of all links into a column vector a, the total sum 
of AMink kinetic energy could be written as a linear equation of a as 


2 KE = [q T I-q } 2 . . . 


(6.31) 


with 


a — [af a% • • • a£] r e 7l l0N 

A linear relation of a could also be found for gravitational potential energy 
expressions. Since among the constant parameters only m and mr show up 

m gravity force, the derivation of the 1th link gravitational potential energy 
is straightforward as 

(■ p E g )i = mg-(P + r ) 

= (9 ■ P)m + (g ■ mr) 

— [(? ' P) (9 ■ i) (g -y) (g ■ z))[ai a 2 a 3 a 4 ] T 
= [{9 ' P) (g ■ x) (g ■ y) (g ■ z) 0 0 • • • 0] a, 

= [(^1 )(%)••■ (W 10 )]ai 
= [P£i]i a/ (6.32) 

where g E Tl 3 is vector of gravitational acceleration, and [V£ t ]f e TV 0 , with 
(VEj) as the jth element, is defined for notational convenience. Therefore, 


PE = tiPZh im 2 • • • mU a + J 2 (PE.) t (6.33) 

/=1 

Since the time derivative and partial differential in the Lagrange equation 

(6.34) 


d dKE dKE dPE 
dr dq dq + dq 


v 

0 


are linear operators and a is a constant vector, the linear form of a is main- 
tained in the final dynamic equations. In the above equation, v is an n 0 
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vector of generalized actuator force. Before presenting details of the dynamic 
equations, the resilient potential energy term, YliLi(P E*)u hi the Lagrange 
equation is moved to the right-hand side and placed under the vector of gen- 
eralized force as 


v 

0 



V 

/ I 

-K{3 


s <s n 

where K G 7 Z n ^ Xn0 is a diagonal stiffness matrix and G is vector 

of compliant deformations. This arrangement makes the dynamic equations 
exactly linear in a in the following Lagrange equation 


d,dKE, dKE , d _ 

a^-TT + aJ©^- 


V 

-K(3 


(6.35) 


'/i ' 


V 

J2 . 


-K0 


Recalling that in the previous chapters the inertial dynamics with well-known 
system inertia are expressed as 

I'q + 

similar notation will be used here. In the above derivations, \ q T I*q and V£, 
are respectively the kinetic and gravitational potential energy associated with 
a unit inertial parameter a, of a given link, they are deliberately formulated 
so that every I* is symmetric, hence the dynamic equation associated with 
a, could have a familiar form of 


w+ 


(/l). 

(f*)i 


£ . gcynrj) , _ mfm ape, 

dt dq dq dq 


with 


(/i)i 

(/ 2 ), 


h , dQfltq) dV£i 
~ iq dq dq 


(6.36) 


(6.37) 


And for the whole manipulator 

"f/'3 + 


(M 

(h)> 


a = 


« 1 r / e 

-K0 J ’ \ i e {1,2, 


,10} 


(6.38) 



4 


229 


which is further defined as 


Z'a = V 

where U' = [u r (- K0 ) T ] T , and 


(6.39) 


z o = z o (?,</,?) = 




g 7^( n 0+ n £) x iotv 


where the subscript l denotes the inertial dynamics of link l, and i means the 
dynamics of a unit parameter a; of link /, in which i — 1 , • • • , 10. Since the 
final inertial dynamics are composed by elements /*, /*, and §~ q {\q T I*q), they 
are tabulated in Table 6.1 for « = 1, 2, • • • , 10. Apparently, for given Z' and 
U , a could be estimated from the linear equation Z' G a = U'. But Z' Q contains 
joint acceleration q, and general manipulator sensor only provides position q 
and velocity q readings, therefore, the inertial dynamics are integrated with 
respect to time to remove dependence on acceleration signals. Because inte- 
gral is a linear operator, the linear relation of a is intact after integration. By 
defining Z 0 = f Z' Q dt and U = f U'dt, the final linear equation is 


Z 0 a = U 


(6.40) 


and Z 0 - Z 0 (q,q). This equation will be used to derive an estimation algo- 
rithm for uncertain a in the next section. The above Z 0 could be derived 
term by term from the following integration equation 



dt = (I*q)i - + J 


(f l), 
(/a),- 



(6.41) 


with i e {1,2, - * * ? 10} and l £ {1,2, -,7V}. Notice that /* = i*(q,q) is in- 

dependent of acceleration. As an example, details of the the above dynamic 
elements are listed in Table 6.1 for link /. A part of Table 6.1 results are used 
to construct (/j), and (/ 2 ), defined by Equation 6.37. 
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A* 
i i* 

% r ^<z) 

dq 

IU 4 
^4 


5(9 T/ 2-»49) 

dq 


T* 

i 5-^10 

T* 

1 5-*lO 


djfJUw q) 

dq 


tG p 

rGi 


Table 6.1 

m, T G T p T G T p 

mi rGp rG p + mi j G p tG p 
q T rH p T G p q + q T T G p T H p q 

- T G T p ■ (s x r G p ) - { T G r p ■ (s x rG p )} t ; s = x,y,z 

- tG p • ( 5 x rG p ) — rG p • (i x rG p ) 

- rG p • (s x rG p ) 

+ { _ xG> ■ (s x rG p ) - rG p • (i x rG p ) 

- T GJ • (3 x rG p )} t 
-q T { T H p • (s X rG,)}? 

- f{ tG t p • (-(3 X rG ,) X rG,)}<7 

- q T { tG T p • (3 X R H t )}q 
+ {-f{ T Hj-(sx rG,)}? 

-3 T {tGJ-(-(3X rG,)x R Gi)}q 

- q T { rG p • (3 x Rtf,)}<j} T 
rGJtj^tJ rGi 

rGJTJ^T? r G,+ rGJ TJ piTf RGi 
+ rGJT^T? rG, + rGJ T tlpiTf rGj 
<? T ( RH?)T t I pt T? R Giq + f rGJ ( VT/)/pjTj T rG,<? 

+ <j T H Gf T, J p ;(V7f) rG,5 + <f rGJ T iIpiTf ( rH,)? 

tH p Q 

= RHiq 
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T t = [x y z] 

Ti = [(w x x ) (u> x y) {uj x z)\ 

VT, = [(-x x r G,) (- y x r G,) (-z x r G ,)] 

(end of Table 6.1) 

6.2 The Least Square Estimation Method for Constant 
Linear Parameters 

In linear equation Zqsl = U, with Zq £ 7 Z( ne + n p) xl0N a ^ 7Z 10N 

and € ll n «+ n f>, for given Z 0 and 17, existence of a unique solution a relies 
on the relation between U and the column space of matrix Z 0 . If U is in 
the space spanned by the column vectors of Z 0 , then at least one a satisfies 
the equation. In contrast, if U is not entirely inside the column space of Z 0 
then there is no solution to the equation. However, Z 0 = Z 0 (g,q) which is a 
nonlinear function of position and velocities, hence its column space changing 
not only with position but also with speed of motion. Therefore identifying 
the relation between U and Z 0 directly is not a proper way of solving a. 
Despite the difficulty of obtaining an exact a, an alternative way is to find an 
estimate a that has minimal estimation error defined as ||Z 0 a — t/||, which 
is generally known as the least square method. The algorithms of the least 
square estimation method could be found in [Astrom and Wittenmark, 1989] 
and [Li and Slotine, 1987]. Since Z 0 is a nonlinear function varying with 
position and velocity and a is a constant vector, the time history of Z 0 is 
included in the optimization process by defining a cost function as 

J(a(t)) = j\-°^\\Z 0 {s)h{t) - U{s)\\>d3 (6.42) 

in which is an exponential forgetting factor with a > 0 to weight 

higher on current error than far past one. To find an optimal a, the gradient 
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of cost function J( a) with respect to a is set to zero, which produces 

/‘ e-°^ZZ{s)Z 0 (s)dsk{t) = /' e-°^Zl{s)U{s)ds (G.43) 

Jo Jo 

or 

R-'k = 0 

with i? -1 e 7 ^ioA’xioA r anc i q ^ 7£ 10jV defined respectively as 


R~ ld ^ / e~^Zl{s)Z 0 {s)ds 
Jo 

(6.44) 

0 = f e-< t ~^Zl{s)U{s)ds 
Jo 

(6.45) 


since ZqZq is a positive semidefinite matrix, R~ l could become positive def- 
inite and invertible after integration. This condition is defined as persistent 
excitation. If R exists, then 

a = RO (6.46) 

However, the convolution integrals in R _1 and O require storage of all past 
data, and in addition, on-line inversion is required for R, therefore the above 
approach is ineffective in computing a. An alternative and efficient way of 
computing a is to integrate a and R recursively by 

rt+ At . 

a (t 4- At) = a(t) T J Hdt 

rt+ At . 

R(t -j- At) = .R(f) T J Rdt 

where R could be obtained from il -1 and its time derivative {R~ l ). For 
persistently exciting system, R~ l > 0 so RR~' = I whose time differentiation 
gives RR~ l R(R~^) = 0, hence R — —R(R~ l )R. 

Since in Equation 6.44, both integrand and integral limits are func- 
tions of present time t, Leibnitz’ rule is applied to find (-R -1 ), which states 
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that for a given integration defined as 

R~ l — f </> (s,t)ds 

JaU) 


ifs time derivative is 


Since in our case b(t) = t, a(t) = 0 and <f>(s,t) = Z ( ‘\s)Z 0 (s), 

(«'-■) = 

Jo at 


— 


^(OZoCO-aiZ-' 


which gives 

7?(/) = oR{t) - R{t)Z*(t)Z 0 {t)R(t) 

and similarly 

o = zZ(t)U(t) - oo 

From Equation G.4G, a -- R() which has a time derivative 


k = RO + RO 

= (^/?-/?Z 0 r Z 0 /?)O + iZ(Z 0 r ^_ ( 7 O) 

= RZq(U — ZqRO) 

= RZj(U — Z 0 a) 

= - /?Z 0 7 e 

where e is the estimation error defined as 


£ 


def 


Z 0 a - U 


= Z 0 (a - a) 


(G.47) 

(C.4S) 

(C.40) 

(G.50) 

(G.51) 
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Once Z 0 and U are available in estimation process, R and a are computed 
from Equations 6.48 and 6.50 and then integrated over a time step to update 
R and a. One comment on the above update algorithm is about the initial 
value R( 0). At t = 0, the upper integral limit of R~ l in Equation 6.44 is 
zero, which means that i? _1 ( 0) = 0 and R( 0) = oo. It is improper to use this 
initial value to estimate a, so a nonzero but small value is practically chosen 
to be the initial value of i2 -1 , therefore, i2(0) is large but finite. Generally, a 
diagonal matrix is chosen to be i? -1 ( 0). This replacement of initial value has 
minor effect on the precision of i? _1 (<) value in the long run, which can be 
shown by an analytic integration of (R- 1 ) in Equation 6.47 which produces 

R~'(t) = 0) + f e-^Z^(s)Z 0 (s)ds (6.52) 

the above equation shows that i? -1 ( 0) decays exponentially with time and 
has almost no effect on i? _1 after a large t. 

Since the least square method finds an estimate minimizing the cost 
function J, it is important to further examine the convergence of the estimate 
to an exact value. First, let a = (a-a) be the estimate error, so for a constant 
a, a. — k = RZ%e by Equation 6.50. Then, a Lyapunov type function is 
defined as 

V = a T R~ x a (6.53) 

where R~ l is positive definite for a persistently exciting system, hence V > 0. 
V a ^ 0. It can be shown from Equations 6.47 and 6.51 that 

V = 2a T R~ 1 k + a T (R- 1 )a 

= -2a t R~\RZZs) + ~a T {-oR~ l + Z^Z 0 ) a 
= — £ T £ — OV 


(6.54) 
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since a > 0 and V > 0 for ail a / 0, then V < 0, V a / 0, which means 
that the estimation is stable and convergent. Another way of investigating 
convergence is by direct integration of S defined as 


a = a = —RZqS 

= —RZq Z 0 a 


From Equation 6.47, 


(6.55) 


Z*{t)Z Q {t) = (R-') + oR-' 

a substitution of the above expression into Equation 6.55 produces 

k = -R{{R-')+oR~ l )& 
which has an equivalent form of 


R~ 1 k+(R- l )k + air 1 a = 0 

After multiplying both sides by e at and using time differentiation, the above 
equation becomes 

|(^«- a )=0 

Let a(0) denote the initial estimate error, then 

e at R~\t)k{t) = i2 _1 (0)a(0) 

and 

a(f) = e-"‘i2(<)i?- 1 (0)a(0) 

Recalling that a = (a — a), 


a = a + a = a + e a ‘R(t)R _1 (0)a(0) 


(6.56) 
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for finite J R“ 1 (0) and a(0), a -+ a as t -> oo, therefore, for persistently exciting 
jR _1 , a approaches to a as t increases. Hence, convergence of estimate to exact 
solution is ensured provided that the system is persistently exciting. 

Obviously, an essential requirement of the least square method is the 
condition of persistent excitation, or R~ l > 0. From Equation 6.44, far past 
Zq Z q terms decay exponentially with elapsed time, so near time Zq Zq terms 
must have full rank to maintain a positive definite J2 _1 . This means that the 
column vectors of near time Zq Zq must span the space that a resides. This 
could be verified by a simple examination of Equation 6.44 which is rewritten 

as 

ir> = /“ e -°V-‘)ZS(s)Zo(s)ds + f 6 -’<■-> Z„ T (s)Z„(s)<fa (6.57) 

JO Jt 1 

with 0 < t\ < t. If R " x stops excitation after <i, the first integral becomes 
zero quickly as t increases, but the second term is positive semidefinite, so the 
inverse of R~ l is not ensured. In other words, in order to have an invertible 
i the second integral must maintain positive definiteness and hence be 
persistently exciting. 

Notice that with persistent excitation, convergence of estimate also 
can be shown for the case of a = 0, i.e., equal weight on all data in Equa- 
tions 6.44 and 6.45. For a persistently exciting system, i2 -1 grows continu- 
ously with time while its inversion R reduces in magnitude and eventually 
becomes zero. From Equation 6.56, with <7 = 0, 

a = a + iJ(t)i? -1 (0)a(0) (6.58) 

for finite R~\ 0) and a(0), a -» a as R -> 0. But according to Equation 6.56, 
due to exponential decay, an estimate with exponential forgetting converges 
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faster than one without exponential forgetting. For estimation without expo- 
nential forgetting, the above recursive formula, Equations 6.48 and 6.50, are 
legitimate after replacing a with zero. 

Application of the least square method requires well-known Z 0 and 
U. Generally, in an off-line calibration of manipulator inertia, simple com- 
mands like sinusoidal or trapezoidal functions could be used to create ma- 
nipulator motion, from which position and velocity readouts are collected to 
construct Z 0 and U . However, some inertia might not be activated during a 
given motion. For example, if one particular link has no rotational movement, 
its moment of inertia is not excited. If this happens, the system is not persis- 
tently excited and estimate may not converge to the exact value. Therefore, 
more tests involving different manipulator configurations are useful to assure 
the accuracy of estimation. Once structural inertia are calibrated, they are 
treated as known parameters, which makes payload inertia the major un- 
certainty in robot controller. In the next section, an adaptive controller for 
compliant manipulators is introduced, which conducts on-line estimation of 
uncertain payload and uses estimates to form control commands for trajectory 
tracking. 

6.3 Adaptive Control Algorithm for Compliant Manip- 
ulators with Payload Uncertainty 

Before presenting the adaptive control algorithm, compliant manip- 
ulator dynamics are reviewed briefly. In the followings, manipulator inertial 
parameters are assumed well-known and payload is the only uncertainty to 
the controller. For a compliant manipulator, the dynamic equations, includ- 
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ing payload, are derived in Chapter 3 as 


' A', E T ' 

' 9 ‘ 


fi 1 


V 

_ E A 2 _ 

J. 

+ 

. f 2 

— 

-K0 


(G.59) 

where A( £ 7 Z neXne , E £ 7^ n ^ Xne , and A 2 G 'R n0 * n0 are elements of the 
generalized inertial matrix composed of nonlinear functions of actual joint 
displacements, 9 £ 1Z ne , and vibratory modal amplitudes, /? £ TV 10 . Also 
f[ £ TZ ne and / 2 G TZ n0 are coupling terms containing Coriolis, centrifugal, and 
gravitational forces, which are functions of 9 , 9 , /3, and 0. Note that actuator 
dynamics are excluded from the above expression. Let subscript k denote the 
known system parameter and subscript u represent the uncertain payload 
dynamic parameter, then the generalized inertial matrix in Equation 6.59 
could be divided into 


a; e t 

E A 2 


a; e t 
e a 2 


+ 


j k 


A' E T 
E A 2 


(6.60) 


and L fi 1 fTV is composed of two parts as 


n 

h 


n 

f 2 


+ 


n 

h 


(6.61) 


For uncertain payload, section 6.1 shows that a linear expression of payload 
inertial dynamics are given by 


Z'a = 




(/i)i 

(/aX- 


a; i £ {!,••■ ,10} 


(6.62) 


where a G contains payload constant inertial parameters 

[<3l <J 2 O3 <14 U5 Oq &7 0-8 a 9 Ctio] = \pO TTir x TTIT y TXXT z Ip XX Ipxy Ipxz Ipyy ^ pyz Ipzz] 

and q = [6 T /3 T ] T . Since q is independent of a, Z' Q a has an equivalent form of 

z; a = | “‘ " I I - I + I V I (6.63) 


a; 

E T ' 


' 9 ' 


' fi ' 

E 

a 2 

u 

J. 

+ 

h 
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in which 


and 


a; s t 

2 A 2 


10 

U 1 = 1 


/i' 

/a 


10 


= £ 


i=i L 


</.)( 

(/*).- 


(6.64) 


(6.65) 


tion m con- 


Since it is preferable to have a complete system dynamic descripti 

trailer design, actuator dynamics are added to the above equations, which 
are defined in Chapter 3 as 


J 9 + D9 + K c 9 -f- v = u 


in which the generalized actuator force ti is defined in Equation 6.59 as 


» = [a; e*u 


9 

a 


+ (f[)k + [AJ E r ]„ 


9 

a 


+ (/ 0 « 


Substituting the above v into actuator dynamics and defining 

(Ai)* = (A i)* + J 
(fi)k = (f[) k + D9 + K c 9 

(Ai). = (a;) u 

(/l)u = (/()« 

the total system dynamics become 


Ax E r 
2 A 2 


9 

a 


+ 


/ i 

h 


with 


Ai £ r 

2 A 2 


fi 

h 


Ax £ r 

2 A 2 

. ' h 
h 


+ 


u 

-K/3 


Ax E T 
2 A 2 


+ 


/ x 
/ 2 


( 6 . 66 ) 


(6.67) 


( 6 . 68 ) 


( 6 . 69 ) 
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In the following control law development, uncertain payload inertial param- 
eters will be estimated on-line. For the purpose of distinction, a hat, (•), 
will be used to denote estimate of an uncertain element, and tilde, (■), will 
represent the error of estimate. For example, el is the estimate of a and 
a = (a — a). Similarly, for the uncertain term in Equation 6.64 the estimate 
and estimation error are expressed respectively as 

Aj E T 


S Ac 


10 

= Ec* 

i=i 


(6.70) 


and 


A! t T 

t A 2 


10 

= 

i = 1 
10 

= E C «. 

i=i 


and so forth. 


The adaptive controller for dynamic Equation 6.67 will be con- 
structed from two considerations. First, it is desirable to assign each nominal 
and vibratory mode a specially designed acceleration composed by feedback 
of position and velocity values and feedforward of desired position, velocity, 
and acceleration. Ideally, this assignment will produce an error-driven dy- 
namic system which has an exponential decay response after proper selection 
of feedforward and feedback gains. If accomplished, nominal displacement 
would converge to the desired trajectory and structural oscillation would be 
eliminated simultaneously. However, the system has ng T ti p degrees of free- 
dom but only has n e actuator inputs. The acceleration assignment from 
actuator inputs is a mapping from 7Z ne space to 72. n ®^ n ^ space, and finding 
exact inputs for the designed accelerations is equivalent to solving an overde- 
termined problem, therefore, unless the assigned acceleration is in the range 
of mapping, no solution or actuator inputs could generate the ideal result. 
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Smce a direct assignment of designed acceleration is difficult due to 
dimensional mismatch, the Lyapunov’s second method is applied to assist con- 
troller design. The merit of the method, besides simplicity, is that it defines 
stability criteria in R 1 space, which will eventually transfer the control design 
from an overdetermined to a redundant problem. In applying the method, a 
quadratic form of error state is chosen as the Lyapunov function which has 
a positive scalar value for all nonzero error states. The actuator inputs are 
structured so that the Lyapunov function has negative time derivative as long 
as error state remains nonzero. Consequently, error state approaches to zero 
asymptotically, and convergence of nominal and vibratory displacements to 
the desired states and estimates to actual values are ensured. 

According to the first consideration, for desired trajectories 9 r and 
/? r , the designed accelerations are defined as 


B d = 0r-K pe (9-6 T )-K Ie {0-0 r ) 

fid. — fir — Kpflifi — fir) — Kjp(ft — fa) ( 6 . 71 ) 

where A>, K„ € W«~ and K„ e are diagonal constant gain 

matrices. Let c, € TV* and e 0 € be the error states defined as 

e e — (0 — 9 r ) + K p g($ — ^ r ) + Kjq J ($ — 9 r )dt (6.72) 

e 0 — (fi — fir ) + K p p(fi - Pr) + Kip J (ft — ftr)dt ( 6 . 73 ) 

then e e = 9- 9 d and e 0 = ft - fa. Equations 6.72 and 6.73 are two simple 
ordinary differential equations with stable eigenvalues after proper selection 
of gain matrices. For zero e* and e 0 , the differential equations are homoge- 
neous, and transient response of (9 - 6 r ) and (ft - fa) decay exponentially. 
Furthermore, by taking the Laplace transform of the above equations and 
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using the final- value theorem, it can be shown that e# — ► 0 8 — * 9 r and 

e 0 -* 0 =► 0 -* 0r- This implies that if nominal and vibratory accelerations 
obtain the designed values, 0 will track the desired trajectory 6 r and vibra- 
tions will be suppressed by setting /? r = p T — Pr — 0. Since the designed 
acceleration is a vector in 71"*+^ and the control vector is in 7 l n ° space, it is 
generally difficult to create the desired assignment, therefore, the Lyapunov’s 
second method is employed to assist controller design. Since exact payload is 
uncertain, estimation of payload parameters will be included as part of the 
design criteria. 

First, a dynamic term defined as 


Ax E r 
E A 2 


0 d 

Pd 


+ 


h 

h 


(6.74) 


is subtracted from both sides of Equation 6.67, which results in 
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(6.75) 


then by adding and subtracting an estimated term 

+ 


Ai E T 

E A 2 


e d 
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h 

h 


(6.76) 


to the right-hand side of Equation 6.75, system dynamic equations become 
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(6.77) 


The input u is chosen in a composite structure 

u = Ui + u 2 


as 


where u A is defined as 
= [At 


# d 

04 


+ ( fi)k + [A, E r ] u 


By introducing two notations Zi and Si 
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04 


+ (/l )v 


(6.78) 


(6.79) 


as 


ry ~ def 

Zia = 


Ai E T 
E A 2 
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fl 

fl 
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(M . 


and 


j a, 


(6.80) 


Si = [E A 2 ]* 


0 d 

04 


+ {f2)k + [E A 2 ] u 


9 d 

04 


+ ih)u 


(6.81) 


with Z, € and S, £ then Equation 6.77 is reduced 


to 


'A a 

E T ' 

60 


«2 1 

E 

a 2 

. ** . 


1 

1 

& 


+ Zia (6.82) 

To find a u 2 stabilizing the system in Equation 6.82 and eliminating payload 
estimate error d, a Lyapunov function is selected below. Since the inertial 
matrix in Equation 6.68 is positive definite, the selected Lyapunov function 


IS 


V = ±pe a 


1 


e + Aa t R J a 


(6.83) 


At E T 
E A 2 

where e = [ej e T 0 ) T € and p is a positive scalar constant whose 

function is to assist payload estimation as shown later. The purpose of adding 
the quadratic term of a in V is to include payload estimation in controller 
design. A similar Lyapunov function is proposed by [Slotine and Li, 1988] to 
control rigid robotic manipulators. In the above equation, R~ l is defined in 
the last section as 
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which is a positive definite matrix for a persistently exciting system. How- 
ever, unlike the last section derivations, now the only uncertainty is payload 
instead of the whole structural inertia, therefore, Z 0 is redefined. From Equa- 


tions 6.63, 6.67, 6.68, and 6.69 

7 , _ Ui E r 

Z ° a ~ E A 2 


9 

a 


+ 


h 

f2 


u 


'Ax E T ■ 


’ 6 ‘ 


' h " 



E A 2 _ 

k 

J . 


./2. 


def 


lei jjf 


(6.84) 


then Z 0 = f Z' Q dt and U = / U'dt. The integration is to remove the require- 
ment of acceleration signal in Z' Q . From the above relations, an estimate error 
e is defined as 


e = Z 0 k — U 
= Zo(k — a) 

= (6.85) 


From Equation 6.83, the time derivative of V is 


V = pe 1 


'Ax E T ' 

1 T 

Ax E T ' 

E A 2 _ 

e + -pe 

E A 2 


e + a T R- 1 k -I- \* T (R- 1 ) a (6.86) 


where the derivative of the generalized inertial matrix could be decomposed 
into known and uncertain paxts as 


A! E T 

t A 2 


Ax E T 
t A 2 


+ 


J k 


Ax E T 
E A 2 


and recalling that 


then for constant a 


Ax E T 
E A 2 

Ax E T 

E A 2 


10 

= Ec». 

J u i = l 
10 
»=i 


(6.87) 


J u 


( 6 . 88 ) 
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According to the above result, the associated quadratic term in V could be 
replaced by a compact notation Z 2 a defined as 


Z 2 a e 


A, t T 

t a 2 


10 


= £(e T ireH 

t=l 


(6.89) 


clef 

2a = e 


• cT 1 
Ai E 


E A 


•2 J 


10 


= E( eT j;e)a, 


t=i 


(6.90) 


^ ~ def 

^ 2 a = e 


r r T 1 

Ax E 


L E A 2 
= E(^e)a,- 


10 


1=1 


(6.91) 


and 


(6.92) 


Z 2 a — Z 2 sl — Z 2 a 

where Z 2 € 7 l 10 . Notice that in the above definitions a is replaced by a and 
a directly after time derivative, which means that no or A term appears 
in the above operations, so hat and tilde are placed on the top of Ai, E 

and A 2 to denote this relation. After substituting the above expressions into 
Equation 6.86, V becomes 

* - T 


V = pe T { 


U 2 

-Kfi - Sx 


+ 


A, E T 

s A 2 


j* 


1 

e+ 2 


A x E 
L E A 2 J 


+pe T Z 1 a + a T R~ 1 k + ia r (J? Ll )a - -pZ 2 a 

^ 2 


7 

U ) 


(6.93) 


Further simplification of V expression is possible by defining u 2 as 


u 2 = “3 - ^[A, E T ]*e - l[Ai E^e 


(6.94) 
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and introducing a new notation S 2 defined as 


S 2 = -[S A 2 ]jte -f -[S A 2 ] u e 


( 6 . 95 ) 


also using the last section derivations that (R 1 ) = -oR 1 + Z$Z 0 , and 
Z 0 a = £. By combining these results, V becomes 


V 


pe 


u 3 

-JT/J -Si + S 2 



+ a T (R *a - 2 p Zj + P%T e ) 


( 6 . 96 ) 


Since the goal is to have a negative V for all nonzero e and a, a is selected 
to create a relation that 


R-'i-lpZZ + pZfe=-ZZe ( 6 . 97 ) 

which means that parameter updating formula is 

4 = R(\pZj - pZje - Zje) (6.98) 

Additionally, by an earlier definition e T = a T Zq , V results in 

— —e T e — ha T i2 _1 a (6.99) 
2 2 

where the last two terms in the right-hand side are in negative quadratic 
form, therefore, U 3 is chosen to produce a negative first term. Since the first 
term is a scalar value and could be expanded as 


V = pe 1 


ti 3 

-I<0 -S x + S 2 


P e 


U 3 

-I<p - Si + S 2 


= p{eju 3 + ep(—K(3 — Si + 5 2 )} 


( 6 . 100 ) 


then Us could be chosen so that 


#u 3 + e T J-K0 -Si + S 2 ) = ~e T e 


( 6 . 101 ) 
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with a! a positive constant, therefore, 

V = -a ie T e - l -e T e - T R~'k (6.102) 

In the above expression, V < 0, Ve and a # 0, which means that the designed 
controller will make [ej e *]* -> 0, or implicitly * 6 T and ft, and also 


Since Equation 6.101 is a scalar function of n^-vector u 3 , finding a 
w 3 satisfying the equation is solving a redundancy problem, hence more than 
one solution exists for Therefore, additional criteria could be enforced in 

the selection process. Here, u 3 is chosen to have a minimum Euclidean norm 
value J| W3 [| . By defining 


74 — K ft — Si + ■S'2) H — -e r e 

P 


Equation 6.101 could be rewritten as 


(6.103) 


ej u 3 + 7i = 0 

which has a minimum norm solution 


(6.104) 


(6105) 

for e, # 0. Notice from Equation 6.99 that when e„ = 0, u 3 has no effect on V 
and a negative V is not ensured. To resolve this problem, the Lyapunov equa- 
tion could be modified by adding a positive term ltlju 3 into Equation 6.83 
which becomes 

e + g + \ulu 3 (6.106) 

then following the above derivations, 




Ax E T 
S A2 


V peju 3 + pe%(-K0 - S x + S 2 ) + uju 3 - ]-e T e - \<rk T R- x h (6.107) 
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in which u 3 will be chosen to satisfy the equation 

peju 3 + pep(—K/3 - S x + S 2 ) + ulu 3 = -a2«J«3 - «ie 7 e (6.108) 
so that 

V = — Qie T e — a 2 u^u 3 — — -<ra T i2 -1 a (6.109) 

where a 2 > 0. Again minimum ||ti 3 || criterion is applied to assist selection of 
u 3 . By defining 

72 = peju 3 + pe T 0 (-Kfi - S t + S 2 ) + a 2 «3 u 3 + aie r e (6.110) 

the solution u 3 is 

U3 = _ lRiF U3 (6 ' 1U) 

provided that u 3 7^ 0. In the modified Lyapunov function, V < 0 for all 
e and a ^ 0 is ensured for it 3 7^ 0. Since u 3 is the control input, it could 
be manipulated directly to have a nonzero value during control process. Or 
from Equation 6.111, since ii 3 is proportional to 72 defined in Equation 6.110, 
by choosing very small p, au, and a 2 , u 3 varies slowly and could have a 
nonzero value. Since both actions require adjusting u 3 at the beginning and 
end of motion which might create disturbance to the system especially when 
nominal joints are at steady state, the first controller is preferable. Notice 
that although the first controller can not guarantee a negative V when eg — 0, 
yet at eg = 0 the nominal trajectory $ has reached steady state 0 r , and 
estimation should converge to the exact value in the early stage of control 
for a persistently exciting system, therefore, control could be ceased, which 
allows structural damping to dissipate residual oscillation naturally. 

In Equation 6.98, the estimate update equation is defined as 
i = R(i?Zf - pZfe - Zqc) 
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and m the least square method the update equation defined in Equation 6.50 
is 

k = ~rZq£ 

for a constant a. By comparing both results, it is apparent that with a 
very small p, the estimation derived by the Lyapunov method will act like a 
least square result which is designed purely for estimation. Another advan- 
tage of using small p to improve estimation performance can be seen from 
Equation 6.99 which states that 


V = pe T 


-Kp-Sr + Si 


1 

2 * 


~ - £<ra r .R -1 a 


in the case that e g — 0 and e 0 ± 0 the above equation becomes 


V = pejgi—Kft -S 1 + S 2 ) - l e T e - ^a T R~ l a 


( 6 . 112 ) 


and V > 0 occurs at 


pe 0 ( K/3 - Si + S 2 ) > -e T e + ^<ra T R 1 a 

thence convergence of e 0 and a are not ensured. Recalling that e = Z 0 a, the 
above inequality could be rewritten as 

P$(-K(i -S l+ S 2 ) > ±a T (Z 0 T Z 0 + *Rr ') a 

which could be interpreted geometrically as a ball of a bounded by pe%(-K/3- 
Sr + S 2 ). So when a enters the ball defined by p, convergence of estimation is 
not justified because of V > 0. But a small p will reduce the size of unjustified 
region and result in better estimation. Hence, a small p will be adopted in 

the later case studies. The adaptive control system block diagram is shown 
in Figure 6.2. 




Figure 6.2 Adaptive Control Block Diagram 




6.4 Numerical Case Studies: Case 1 

4 

Verification of the designed adaptive controller is conducted numer- 
ically on the motion control of two flexible manipulators carrying uncertain 
payload. The first model is a three DOF manipulator modeled with three 
lumped link compliances as depicted in Figure C.3, whose system parameters 
are listed in following tables. 


Table C.2 3-Link Model Kinematic Parameters I 


Link Length (m) 

(*> y, z) 

Center of Mass (m) 

(*. y, z) 

Offset 
Angle (deg) 

Link 1 

(0, 0, 1) 

(0, 0, -0.5) 

0 

Link 2 

(12, 0, 0) 

(0.5, 0, 0) 

90 

Link 3 

(1.4, 0, 0) 

(0.5, 0, 0) 

0 


Table 6.3 3-Link Model Inertial Parameters 1 


Mass 

(%) 

Moment of Inertia ( kg.m 2 ) 

{Ixxi Iyyi lit) 

Link 1 

300 

(0, 0, 30) 

Link 2 

GS0 

"" (6, 53, 44) 

Link 3 

450 

(50, 8, 50) 


Table 6.4 3-Link Model Actuator Parameters 



Joint 1 

Joint 2 

Joint 3 

Inertia (10 -3 • kg • m 2 ) 

4.2 

2.1 

2.1 

Damping (N ■ m/(rad/s )) 

0.4 

0.4 

0.3 

Resistance (ohm) 

0.8 

0.8 

0.8 

Torque Constant (volt/ (rad/ s)) 

20 

20 

14 

Gear ratio 

100 

100 

100 

Back emf Constant (N ■ m/amp) 

0.5 

0.5 

0.4 


and the exact payload and initial estimate are 


Table 6.5 Actual Payload parameters and Initial Estimates 1 


m 

mr x 

mr y 

mr z 

^pxx 

Ipxy 

Ipxz 

^ pyy 

1 pyz 

Ipzz 

a l-.10 

90 

9 

9 

9 

10 

5 

5 

10 

5 

10 

<2i-.io(< = 0) 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 
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The stiffness matrix \s K = diag [(4000000)3] in N/m , where (•)„ denotes 
n repeated diagonal element. The simulation procedure is itemized in the 
following steps. 

6.4.1 Step 1: Selection of Nominal Reference Trajectories 

The reference trajectory selected for each nominal joint is similar to 
the fifth order polynomial function used in the last chapter, which is repeated 
below 

$r0 M/) = tf) + 9 t q 

/((,</) = 6^-15^ + lojJ (6.113) 

where tf is the traveling time of reference joint displacement, and f(t, tf) is a 
normalized polynomial designed with zero velocity and acceleration at t = 0 
and t = tf to avoid shocks that might cause structural resonance. In the 
above equation, A# represents the reference joint displacement, and 9 t q is the 
starting point. In the simulation, an initial positional error is added to check 
the tracking performance, that is, the actual joint will start from a point 
denoted by 0q that is different from the reference initial 9 t q. The positional 
parameters used in this example are tabulated in the next table. 


Table 6.6 3-Link Model Trajectory Parameters 


tf(sec) 

A8(deg) 

9 r O 

El 

E9ESE2S3I 

Joint 1 

10 

60 

0 

6 

6 

joint 2 

10 

70 

0 

6 

6 

Joint 3 

10 

50 

0 

6 

6 


6.4.2 Step 2: Selection of Designed Acceleration 


From Equation 6.71, the designed accelerations are defined as 

0 d = d r -K p e(9-8 r )-K ie (0-e r ) 
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fid = 0 , - - fir) - KntP - fir) 

in which 0 T is the desired trajectory given in the last step, and 6 r and 9 r 
come from consecutive time derivatives of Equation 6.113. In the designed 
vibratory mode acceleration, the desired vibratory mode value (3 r and its time 
derivatives, /3 r and $ T , axe set to zero for oscillation elimination. Therefore, 
the diagonal gain matrices K p g, Kig, K p p, and Kip, which will assign stable 
poles to Equations 6.72 and 6.73, need to be defined. The poles chosen here 
are (-3, -4) for each nominal motion and (-1, -2) for every vibratory mode, 
so the corresponding gain matrices are K p g = diag[(7)3], Kie = diag[(12)3], 
K p p = diag[(3)3], and Kip = diag[( 2 ) 3 ]. With the above parameters, the error 
states eg and ep are evaluated from Equations 6.72 and 6.73 which are 

e, = (0 - «,) + Kje - e r ) + k„ f(»- e r )<it 

*0 = 0 - fir) + Kpoifi - fir) + K ,0 j(fi- fir)dt 

where 9 is a 7Z ne vector of nominal joint displacements and /? is a 7v Tld vector 
of vibratory mode amplitudes. 


6.4.3 Step 3: Construction of Control Input 

The control input u is the conglomerate of Equations 6.78, 6.79, 
6.94, and 6.105 as cited below 


u 


u l 


u 2 


U3 


Ui + u 2 


[Si A T U 



+ ( fl)k + [Si A T ] 


u 3 - i[Si A T ] fc e - ^[Si A ] u e 
7i „ 

rjr eg 

el eg 


h 

h 


+ (/l)u 
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where 71 is defined in Equation 6.103 in which au = p is used in the simulation. 
I 11 the above computation of u :h a safeguard is added to avoid dividing by 
zeio, that is, when the denominator e J eg reaches a predefined range close to 
zero, u 3 is set to zero. This precaution is to prevent numerical errors but 
might affect the resultant V value which according to the Lyapunov’s second 
method needs to be negative to guarantee the convergence of both controlled 
motion and payload estimation. Yet, since eg — > 0 means nominal motion 
approaches desired state, and the convergence of parameter estimation, which 
is approximate to the result of least square method after choosing a small 
P , relies Primarily on the condition of persistent excitation. Therefore, the 
major impact of setting u 3 to zero is on vibration elimination. However, this 
situation generally occurs at the end of nominal motion, hence the residual 
oscillation could be left to be dissipated passively by structural damping. A 
modification of the above approach is updating u 3 by Equation 6.111, which 
could have a nonzero divisor by resetting u 3 , but this will create a disturbance 
on nominal motion, therefore, it is not used in simulations. After constructing 
control input u, motion response is found numerically from system dynamics 
defined in Equation 6.67. 

6.4.4 Step 4: Update of Parameter Estimation 

For constant payload inertia a, a = k where k is given by Equa- 
tion 6.98, then the update equation of estimate a is 

a = R(^pZf - pZ X T e - Zfe) 

in which Z 2 is defined in Equation 6.89, Z 1 is introduced in Equation 6.80, 
Z 0 is the integral of Z' Q shown in Equation 6.84, and e is presented in Equa- 
tion 6.85 where U is the integral of U' defined in Equation 6.84. According 
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to the previous discussion, since a smaller p produces better estimate con- 
vergence, p = 0.001 is chosen in simulation. Additionally, in the simulation 
equal weight is placed on all data used in constructing i?" 1 , i.e., no exponen- 
tial forgetting in estimation is introduced {a = 0), then from Equation 6.48, 
R is updated by 

R — —RZqZqR 

The reason of choosing a = 0 is that if system ceases excitation during simula- 
tion, according to Equation 6.57, a nonzero <7 will turn R 1 into a semidefinite 
matrix quickly and hence cause R to increase drastically. Eventually, a sin- 
gular R _1 makes R go to infinity and destroys the estimation process. In 
general practice, estimation is terminated once persistent excitation stops, so 
an exponential forgetting factor could be employed to speed up convergence, 
but that is not implemented in our case studies in order to observe the kine- 
matic effect on payload excitation. Therefore, a = 0 is used here to put equal 
weight on all collected data. The initial value R(0) used in the simulation is 
a 10 x 10 diagonal matrix with ten repeated diagonal elements of value 1000. 
The integration step in the following simulations is 1 msec. 

6.4.5 Simulation Results on a 3-Link Manipulator Model 

The first model simulation results are reported in the following fig- 
ures. Figures 6.4 (a), (b), and (c) are the traces of nominal joint displace- 
ments. Notice that the desired and actual displacements are separated by 
an initial position error. Figures 6.4 (d), (e), and (f) are link deformations, 
where the final steady state deformations in (d) and (e) are due to gravitation 
force. Figures 6.4 (g), (h), and (i) are control voltages of joint 1 to 3. Figures 
6.4 (j) to (s) are plots of exact and estimate of payload inertia, and Figure 6.4 
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(t) shows the sum of the diagonal element, or trace, of R, as an examination 
of peisistent excitation. As discussed before, for <7 = 0 , R~~^ grows rapidly 
under persistent excitation, hence R and its trace diminishes swiftly and ide- 
ally becomes zero. However, the reduction of the trace of R in Figure 6.4 (t) 
stops at 706.7, hence the system is not properly excited in this case, therefore 
estimation results are impaired. In Figures 6.4 (j) to (m), estimates of mass 
and center of mass location approach actual values, but estimates of moment 
of inertia in Figures 6.4 (n) to (s) fail to reach exact values, which means that 
in the controlled motion payload is insufficiently activated to reflect its true 
value. Since the simulated model is a three-link manipulator without wrist, 
the gripper has limited angular movement to probe the moment of inertia 
of payload, therefore, little information could be collected to reconstruct the 
true identities. In the next case, a six DOF manipulator is simulated, which 
will show improved estimation of moment of inertia with additional angular 
movement of the wrist. 
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6.4.6 Case 2: Simulation on a 6-Link Manipulator Model 

The second case simulates tin* motion control of a six DOF manipu 
lator modeled with three lumped link compliances as depicted in Figure 6.5. 
The parameters of this model are listed in the following tables. 


Table 6.7 6-Link Model Kinematic Parameters 



Link Length (m) 

0, y, z ) 

Center of Mass (m) 

(*, y, z ) 

Offset 
Angle (deg) 

Link 1 

(0, 0, 0.8128) 

(0, 0, -0.4318) 

0 

Link 2 

(1.1776, 0, 0) 

(0.508, -0.0254, 0) 

90 

Link 3 

(0, 0 , 0) 

(0.1016, -0.1778, 0) 

0 

Link 4 

(0, 0, 1.397) 

(0, 0, -0.508) 

90 

Link 5 

(0, 0 , 0) 

(0, 0 , 0) 

-60 

Link 6 

(0, 0, 0.1524) 

(0, 0, -0.1016) 

60 


Table 6.8 6-Link Model Inertial Parameters 


Mass 

(%) 

Moment of Inertia ( kg,m 2 ) 
{Ixxy lyy) ^zz ) 

Link 1 

317.5 

(0, 0, 29.3) 

Link 2 

680.4 

(5.9, 52.7, 43.9) " H 

Link 3 

453.6 

(49.7, 7.61, 49.7) 

Link 4 

68 

(0.59, 0.59, 0.35) 

Link 5 

36.3 

(0.23, 0.23, 0.06) 

Link 6 

27.2 1 

(0.12, 0.12, 0.06) 


Table 6.9 6-Link Model Actuator Parameters 

Joint 

i 

2 

3 

4 

5 

6 

Inertia. (10~ 3 • kg ■ m 2 ) 

4.2 

2.1 

2.1 

1.3 

1.3 

0.8 

Damping (N * m/(rad/s)) 

0.4 

0.4 

0.3 

0.4 

0.3 

0.3 

Resistance (ohm) 

0.8 

O.S 

0.8 

0.8 

0.8 

0.8 

Torque Constant ( volt / (rad fs )) 

20 

20 

14 

11 

8 

8 

Gear ratio 

100 

100 

100 

80 

30 

10 

Back einf Const. (N ■ mj amp) 

0.5 

0.5 

0.4 

0.3 

0.3 

0.2 


and the gain matrix are: K p $ = cliag[(7)c], Kie = diag[(12)c], h p p = diag[(3) 3 ], 
and Kip = diag[(2) 3 ], 72(0), a, and stiffness matrix are the same as the last 
simulation, and a — 0. The nominal trajectories and initial states are given 


in the next table. 
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Table 6.10 6-Link Model Trajectory Parameters 


tj(sec) 

A 0{deg) 

0 rO 

00 

00 — 0rO 

Joint 1 

10 

60 

0 

10 

10 

joint 2 

10 

70 

0 

10 

10 

Joint 3 

10 

50 

0 

10 

10 

Joint 4 

10 

40 

0 

10 

10 

Joint 5 

10 

50 

0 

10 

10 

Joint 6 

10 

60 

0 

10 

10 


Two sets of initial estimates are tested on this model. The first set has zero 
initial estimates as shown in the next table. 


Table 6.11 Actual Payload parameters and Initial Estimates 


m 

mr x 

mr y 

mr z 

Ipxx 

ES 

EfflS 



EH 

ai_,io 

90 

9 

9 

9 

10 





10 

di-uo(f = 0) 

0 

0 

0 

0 

0 

0 

0 



0 


The second set has overestimated initial values as listed in the following table. 


Table 6.12 Actual Payload parameters and Initial Estimates 


m 

mr x 

mr y 

mr z 

WMHk 


WSM. 

Effl 

ea 

wm 

Gl-*10 

90 

9 

9 

9 




10 


10 

di-io(< = 0) 

120 

18 

18 

18 

15 

8 

8 


8 

15 


The purpose of using two sets of data is to test the controller’s adaptive ca- 
pacity to different initial estimates. Besides that a comparison of both results 
will give a better understanding on the phenomenon of persistent excitation 
and how estimation affects controller performance. Both simulations follow 
the same steps listed in the three-link case and the results are presented in 
Figures 6.6 (a) to (z). In order to produce a compact presentation, each 
figure carries two sets of data where a solid line represents response of zero 
initial case and a broken line indicates performance of overestimated case. 
Figures 6.6 (a) to (f) show nominal jointsl to 6 tracking errors, i.e., 6 — 6 r . 
In these figures, the initial positional errors are deliberately arranged accord- 
ing to Table 6.10 to test controller tracking capability. Figures 6.6 (g) to (i) 















































are vibratory mode deflections. The input voltages are displayed in Figures 
6.6 (j) to (o). Figures 6.6 (p) to (y) are estimate errors, a, of ten payload 
inertial parameters, and Figure 6.6 (z) is the trace of R which is treated as an 
indicator of persistent excitation. From the nominal and vibratory motions 
in Figures 6.6 (a) to (i), controller stability is verified. Additionally, estimate 
convergence is revealed from Figures 6.6 (p) to (y) where estimate errors ap- 
proach zero in the first 1.67 sec. Also, the trace of R reduces form 10,000 to 
less than 32 for zero initial case and 220 for overestimated case at the same 
period of time. Both traces of R keep decreasing until reaching a value 4 
for zero initial case and 16 for overestimated case. As stated before, for a 
persistently exciting system, R will become zero eventually. Therefore, in the 
six-link model, the controlled system is persistently exciting, which is essen- 
tial to the convergence of the payload estimates. Such results are in contrast 
to that of the third-link case where the trace of R stops at 707 and payload es- 
timates fail to converge, especially the moment of inertia values. Apparently, 
the wrist in the six-link model generates additional angular motion crucial to 
the excitation of the moment of inertia contents. Such connections provide 
us an insight of the relationship between system physical motion and exci- 
tation conditions required by analytical estimation. Despite the satisfactory 
performance of both zero initial and overestimated cases, some observations 
regarding simulation results will be discussed below. 

For the first three joints, both cases show almost identical response 
as displayed in Figures 6.6 (a) to (c), but the difference shows up in the wrist 
motion according to Figures 6.6 (d) to (f) where the zero initial estimate 
case suffers a large overshoot especially within the first two seconds. Similar 
distinctions also appear in the actuator control voltages shown by Figures 6.6 
(m) and (o). Such results are due to a substantial payload inconsistency be- 
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tween the model and plant. By comparing Tables 6.8 and 6.11, the mass and 
moment of inertia of links 4, 5, and 6 are far less than actual payload values, 
so payload dominates the dynamic effect of wrist motion. Furthermore, in 
the motion control payload is uncertain and estimated on-line, therefore wrist 
control becomes sensitive to estimate precision. According to Figures 6.6 (p) 
to (y) results, the first two seconds is the transient period of estimation in 
zero initial estimate case, depicted by solid line, yields large estimate errors. 
Inevitably, the wrist motion is affected in this transient period. Interestingly, 
the vigorous wrist overshoot of the zero initial case accidently creates better 
excitation to payload than that of the overestimated case, therefore, the for- 
mer has a smaller and faster declining R value as shown in Figure 6.6 (z). 
By contrast, the inertia of the first three links are substantially larger than 
payload magnitude, therefore their motion controls are robust to imprecise 
estimates. However, both zero initial and overestimated cases have similar 
structural deflections, and the steady state deflections in Figures 6.6 (g) to 
(h) are due to the weight of the structure. Notice that in Figures 6.6 (p) 
to (s) mass and center of mass location estimates converge to actual values 
quickly, similar tendencies are also observed from three-link case results, i.e., 
Figures 6.4 (j) to (m). Obviously, payload mass is easy to excite and could 
be estimated precisely in few time steps. 
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Figure 6.6: Adaptive Control of a 6-Link Robot with Zero Initial 
Estimates (Solid Line) and Overestimated Initial 
Values (Broken Line) 
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Figure 6.6: Adaptive Control of a 6-Link Robot with Zero Initial 
Estimates (Solid Line) and Overestimated Initial 
Values (Broken Line) 
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Figure 6.6: Adaptive Control of a 6-Link Robot with Zero Initial 
Estimates (Solid Line) and Overestimated Initial 
Values (Broken Line) 
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6.5 Effect of Update Rate on Adaptive Controller Per- 
formance 

In the real-time implementation of the designed adaptive control al- 
gorithm, controlled system response will be affected by update delay. Since 
robotic dynamics are highly nonlinear, computation of dynamic parameters 
demands finite amount of time. Details of real-time computation of robot 
dynamic parameters are reported by [Wander and Tesar, 1987]. In physical 
implementation, the controller has to use a sequence of periodically updated 
dynamic parameters instead of continuously updated information to generate 
control command. Consequently, the update interruption creates a distur- 
bance to the stability of the proposed controller and affects the controlled 
system response. In this section, update rate effect on controller performance 
will be analyzed, and from the analyzed results suggestions will be given to 
remedy the update disturbance. In the following analysis, subscript o denotes 
a updated value, and A indicates an update rate error at every instance. 

In Equation 6.78 the control input u is composed of 


u = U\ + «2 


(6.114) 


Now, ix i defined in Equation 6.79 is replaced by a periodically updated form 
given by 


U\ — [Ai S k 0 


A 

h 


+ (fi)ko + [Ai E r ] t 


Od 

Ax 


+ (/iX 


(6.115) 


where the subscript o indicates a given update value. With this new Ui, the 
system dynamics in Equation 6.82 become 


' Ai E r 
E A 2 


e 0 


u 2 

—K0 — S\ 


+ Z\a. + 


A, 

0 


(6.116) 
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where A x represents an error of Equation 6.82 due to update delay and is 
defined by 


A x = ([Ax £ T ] fco - [Ax £ r ]*) 
+ ([Ax ± T ] uo - [Ax t T l) 


Or 

K 


Or 

A 


+ (fl)ko ~ (fl)k 

+ (/l)«o -(/i)u (6.117) 


Then, this error is transported to the time derivative of the Lyapunov function 
given by Equation 6.93, that is 


V = pe T { 


U 2 

-I<p-Si 

zT r>—i~ 
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Ax 
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Ax E T 

£ a 2 
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C+ 2 


Ax £ 


£ A 2 


+ pe Zi a + a R a + -a r (i? -1 )a — — pZ 2 a 


(6.118) 


Accordingly, u 2 originally given in Equation 6.94 is now constructed by up- 
dated parameters shown in the following equation 


1 . i ~ ~r 

u 2 = «3 - 2 [Ai S r ]toe - -[Ax £ ] tto e 


this new definition reduces Equation 6.118 to 
V = pe T 


(6.119) 


«3 


Ax + A 2 

-K0 - Sr + S 2 

+ pe 

0 


+ a T (i? *a - ^pZf + pZfe) - ^<rk T R~ l k + ^ e T e (6.120) 


where 


A 2 = -1([A, S r ]t 0 - [A, E r )fc) e 

1 / ? :T ? ;T \ 

- - f [Ax £ ] uo - [Ax £ ]„) e (6.121) 

In the adaptive controller design, u 3 is initially solved from the equation 

e J u 3 + Hi = 0 (6.122) 



now, the solution is updated by 


«3 = 


7io 




with 7 i 0 defined by 


Tip = e p(~ K P - 5i 0 + S 2o ) + — e T < 
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which creates an error A 3 to Equation 6.122, i.e., 


where 


e e u 3 + Ti — e J(5i o — Si — S 2o + 5 2 ) 

= A 3 


A 3 = el(5i 0 — S\ — S 2o + S 2 ) 


With the additional errors, Equation 6.120 becomes 


V = — aqe T e + pA 3 + peJ(Ai + A 2 ) 

1 
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+ a t {R *a - ^pZ% + pZ? e) - ^/?a T i? *a + ^ e T e 


(6.123) 


(6.124) 


(6.125) 


(6.126) 


(6.127) 


(6.128) 


The analysis is now focused on the parameter estimation part in the above V 
equation which is also affected by update delay. According to Equation 6.98, 
the parameter estimation increment is computed by the update form 


whose effect on the original design is derived below 
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with 


AZ 0 = Z 0o — Zq 
A s = £ 0 — £ 

A substitution of these results into Equation 6.128, V results i 
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(6.132) 


(6.133) 


+ p[ A 3 + ej (Aj + A 2 ) + a T A 4 ] + a T A 5 

Apparently, the errors caused by periodical update will create additional un- 
certainty on the stability analysis of V . However, since p is a control param- 
eter decided by users, it could be very small to reduce the error term 
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in the above V expression, which suggests that p could serve as a parameter 
to improve controller performance. Besides this new function, small p has also 
been used to enhance parameter estimation precision in earlier case studies. 
But the V in Equation 6.133 is still under the influence of a T As where A5 
is defined in Equation 6.131. Since A 5 relates primarily to the update errors 
of R, Zo, and e, they are further analyzed in the followings. Recalling the 
definition of Z' in Equation 6.62 that 
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(6.135) 


In order to remove the acceleration dependence of Z' Qo and U' 0 , two integrations 
over time are executed which produce 


Z 0o = j(Z^ + AZ' 0 )dt 
Zo + AZ 0 

U 0 = J{U' + AU')dt 
= U + AU 


(6.136) 


(6.137) 
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where A(-) represents a update error. Finally, the update errors of e and R, 
from Equations 6.85 and 6.48, are 

£o Zq 0 sl U 0 

= (Z 0 + AZ 0 )k-(U + AU) 

= ( Z 0 k -U) + (AZ 0 a - AU) 

= e + Ae (6.138) 

R 0 = cR 0 - R 0 Zq 0 Zq 0 R 0 

= - R o (Z 0 + AZ 0 ) T (Z 0 + AZ 0 )R o 

= oRo - R 0 (Zq Z 0 )R o - R o (AZq)(Z 0 )R o 

-R 0 {Z^)(AZq)R 0 - R o {AZq){AZ 0 )R o (6.139) 

and 

AR = R 0 -R 

Unfortunately, from the above analytical results, no free parameter like p 
could be chosen to reduce the effect of A R, A Z 0 , and Ae on A 5 and hence 
on V values given in Equation 6.133. Furthermore, a small p as suggested 
above means that the estimation process in Equation 6.129 behaves like a 
least square method result which is also affected by the errors of R , Z Q . and 
e. So some practical approaches must be adopted to solve these problems. 
One solution proposed here is to stop estimation once the system ceases per- 
sistent excitation. The reason is that when the system stops excitation, the 
matrix R and its computed value R 0 are small and ideally zero, so the error 
A R is sm all. Also, the previous case study shows that payload estimates 
approach to the exact values when R stops decreasing. This means that e 
and s 0 and therefore Ae are almost zero. Hence the resultant A 5 is small. 
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consequently its effect on V in Equation 6.133 is reduced. One question left 
to be answered is what criterion should be used to decide that a system has 
ceased excitation. In the previous case studies, the trace of R is used as an 
indicator of persistent excitation, so the decrement rate of the trace could 
serve the purpose. Practically, when the decrement rate of the trace is less 
than a predefined value, the estimation process is stopped and the controller 
will use the last payload estimates to compute control command for the rest 
of motion. 


6.6 Case Studies with 100 Hz Update Rate 

The update effect will be demonstrated on the six-link model. Again, 
both zero initial estimate and overestimated examples are repeated except 
that now control parameters have a 100 Hz update rate while the integration 
step remains 1 msec. All system and control parameters are the same as 
before. The major changes are that R( 0) has a value 10,000 for its diagonal 
elements and p = 0.000001 is used to reduced update disturbance. In both 
simulations, the estimation is terminated when the trace of R 0 has a decre- 
ment less than 0.5 over an update step. This 0.5 value is selected based on 
our experience from previous simulation results. Notice that i?( 0) is 10 times 
the value used in the last case study. This selection is to have a better ap- 
proximation to the exact i?(0) which is actually an infinite matrix. However, 
it should be pointed out that a large -R(O) will make estimation too sensitive 
to initial estimation errors. Both simulation results are reported in Figures 

6.7 (a) to (z). In each figure, a solid line represents the zero initial estimate 
case result, and a broken link depicts the overestimated case response. By 
comparing Figures 6.7 with Figures 6.6 where update effect is omitted, it 
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appears that by choosing a small p and terminating estimation the update 
rate disturbance is reduced. The simulations results in Figures 6.7 are similar 
to that in Figure 6.6. The major differences are that the moment of inertia 
estimates in the overestimated case do not converge to the exact values when 
estimation is terminated, as indicated by the broken lines in Figures 6.7 (t) to 
(y). According to simulation data, the zero initial case ceases estimation at 
1.07 sec where the trace of R is 41.9; the overestimated case stops estimation 
at 1.89 sec where the trace of R is 147. Again, the zero initial estimate case 
has better excitation than that of the overestimated case, which is due to the 
large overshoot of wrist motion shown in Figures 6.7 (d) to (f). The case 
study results confirm our suggestion that update delay impact on adaptive 

controller performance could be remedied by using small p and termination 
of estimation. 
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6.7 Comparison Between Adaptive and Non-Adaptive 
Control 

In order to illustrate the merit of adaptive control in uncertain sys- 
tems, we conduct the following comparison. Now, the parameter estimation 
in Figure 6.2 is disconnected from control system. Therefore, by setting 
a = a = 0 for all t, the above adaptive controller becomes a regular con- 
troller built for the system with well-known inertial parameters including the 
payload. Without the parameter estimation, the new regular controller is em- 
ployed to control the six-link model with overestimated payload. This means 
that the regular controller constructs control commands using a set of payload 
values that are larger than exact values. The simulation results are displayed 
by solid line in Figures 6.8 (a) to (f ) for nominal mode tracking errors, Figures 

6.8 (g) to (i) for link deflections, and Figures 6.8 (j) to (o) for control voltages. 
For comparison purposes, the adaptive control results of the overestimated 
case are also presented by broken line. Apparently, without adaptive effort, 
the regular controller has very poor performance in this case. The overshoots 
of wrist motion and the residual oscillation of fa in Figures 6.8 (i) axe un- 
acceptable. Also, the wrist control voltages awe beyond reasonable values. 
However, another aspect regarding this example is that without proper de- 
sign a controller might bring system instability to our studied models, which 
means that the examples used in this report are not intrinsically robust. A 
carelessly designed controller would fail the assigned control task. Of course, 
according to the Chapter 5 results, a well-designed robust controller which 
contains no adaptive loop is applicable to a system with uncertain param- 
eters. Therefore, experimental work should be conducted to compare the 
performance between adaptive and non-adaptive controllers. Some compar- 
ison criteria are suggested below, which axe general for rigid and compliant 
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robotic systems: 

1. settling time: nominal motion and residual oscillation 

2. reference motion tracking precision 

3. required actuator energy 

4. capability of uncertainty estimation 

5. estimation convergence speed of adaptive algorithm 

6. real-time computation effort 

7. robustness to unmodeled disturbance 

8. applicability to compliant structure 

9. applicability to modularized structure 

10. required on-line measurement 

11. tuning capability such as selection of poles in PID, P matrix in the 
Lyapunov function, p in the adaptive control law, and so forth. 

For a given robot and task, different control algorithms should be tested ex- 
perimentally. The results could be tabulated in a matrix format following the 
above listed criteria. This table will help users to choose the best controller 
for a specified task. Unfortunately, due to nonlinearity of robot dynamics, 
selected control parameters like PID gains or the P matrix are difficult to 
parameterize explicitly to analyze their effects on controlled system perfor- 
mance. So, one experimental result could not be extended directly to another 
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task. Therefore, a collection of various task results will be very useful to cre- 
ate a general table containing different controller performance, which could 
serve as an indicator of the preferable control algorithm for a given task. 
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6.8 Summary 

In this chapter, the Newton- Euler and Lagrange methods are intro- 
duced to extract link and payload inertia terms from nonlinear and coupled 
manipulator dynamics. By doing so, the final dynamic formulation could be 
expressed as a linear equation in inertial parameters composed of mass, cen- 
ter of mass location, and moment of inertia of individual link and payload. 
Based on this linear relation, a least square method is introduced to estimate 
the constant but uncertain inertial parameters. The results could be applied 
to on-site calibration of lumped manipulator inertia when drift of modeled 
values is suspected or calibration is required for a new assembled modularized 
structure. The convergence of the least square method is shown by a Lya- 
punov type function and a direct integration of estimate for a persistently 
exciting system. The requirement of persistent excitation to ensure accuracy 
of estimate is also discussed. 

For compliant manipulators carrying an uncertain payload, an adap- 
tive algorithm is introduced to control nominal tracking, vibration elimina- 
tion, and on-line payload estimation. The adaptive control law is applicable 
to rigid robotic manipulators as well as lumped and distributed compliant ma- 
nipulators. Three computer simulations are reported to verify the designed 
results. The first simulation is conducted on a three-link robot modeled with 
three lumped link compliances. In this case study, convergence of estimate is 
impeded due to the limited angular movement of the gripper. To verify this, 
the second and third simulations are performed on a six-link robot where 
wrist motion is implemented. The six-link robot is also modeled with three 
lumped link compliances. With the additional wrist motion, the system is 
well excited and payload estimates converge to exact values swiftly. The sec- 
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ond and third simulations have distinct initial estimates, whose purpose is to 
test adaptive capacity of the proposed controller. The relationship between 
persistently exciting condition and physical motion is observed from a com- 
parison between both simulations. In both three-link and six-link examples. 

nominal motion tracking and vibration elimination are satisfactorily executed 
by the adaptive controller. 

In physical implementation, real-time computation delays create a 
disturbance to the proposed control algorithm which is developed based on 
continuously updated information. In order to remedy the update delay dis- 
turbance, update delay effect on adaptive controller stability is analyzed. 
According to the analyzed results, a small p and termination of estimation 
once system ceases excitation are recommended to reduce the update de- 
lay impact. Case studies are conducted to verify the suggestion. Finally, 
comparison between adaptive and nonadaptive control laws are illustrated 
through an example simulation. Several criteria are proposed to compare 
between adaptive and nonadaptive controllers. It is suggested that different 
controllers should be tested experimentally over various tasks in order to con- 
struct a performance table that assists users to select the best controller for 
a specified task. 



Chapter 7 


Summary and Discussions 


In this report, we have presented a systematic analysis of compliant 
manipulators which covers dynamic modeling, property investigation, and 
both regular and adaptive control algorithms. In the first chapter, we sur- 
vey and categorize more than ninety recently published reports which are 
dedicated to building an efficient, lightweight manipulator that has a large 
payload-to- weight ratio and capable of undergoing high speed and precise op- 
erations. Due to nonlinear interactions between robot nominal motion and 
structural oscillations, the goal of building a general lightweight robot is a 
difficult and slowly developing task. At this stage, many researchers still con- 
duct primitive experiments on simple compliant structures such as one-link 
arms in order to gain insight in dynamic modeling and control problems. Ad- 
ditionally, most of the studies are aimed for spatial applications such as the 
Spatial Shuttle Remote Manipulator System (RMS) which works in a zero- 
g environment where structural inertia is not the main concern. Therefore, 
most one-link models are so light that they can not even support their own 
weights, hence the experiments are limited to horizontal movements to avoid 
gravity effects. So far, a small number of studies, e.g., [Rivin, et al., 1987] 
and [Liao, Sung, and Thompson, 1987], are devoted to improve physically 
industrial manipulator structural design by using composite components or 
materials to reduce link weight while maintaining good rigidity. Other than 
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that studies of lightweight industrial robots are still in analytic and numerical 
simulation stages. 

In order to create a valid description of flexibility dynamics, ex- 
perimental works have been conducted to verify two mostly used compliant 
models, distributed and lumped parameter models. For example, [Tsujisawa 
and Book, 1989] have used a distributed parameter model on a two-link robot, 
and [Behi, 1985] has developed a lumped parameter model for a Cincinnati 
Milacron T3-776 robot. The former shows that the link lateral deflections 
could be depicted properly by the first two fundamental modes. However, 
the first mode amplitude is about ten times of the second mode. Similar 
results are also indicated by [Yang and Donath, 1988], Both reports sup- 
port the assumption used by lumped parameter model that the first mode 
dominates structural deformation and hence it is the only mode modeled to 
create simple but reasonably accurate dynamic equations. In order to retain 
physical reality, the spring stiffnesses used in lumped parameter models are 
actually evaluated from laboratory experiments as reported by [Sklar, 1988], 
[Elmaraghy and Johns, 1988], [Behi, 1985], and [Good, Sweet, and Strobel, 
1984], From these experimental results, it is discovered that even in lumped 
parameter models only finite salient modes could be triggered. Therefore, 
instead of using seven decoupled vibratory modes (i.e., one joint compliance, 
three link end-point deflections, and three link end-point twistings) to define 
lumped compliances of a flexible link, generally, only joint compliance and two 
principal plane deflections are considered in lumped parameter models. Link 
lateral deflections are also the major considerations in most of distributed 
parameter models. Therefore, in this report, we choose robot upper arm and 
forearm lateral deflections as the major link compliances in our case studies. 


322 


Based on availability of payload information, we propose two algo- 
rithms to control compliant manipulators: one is built on well-known system 
parameters, or regular controller, and the other is designed to adapt payload 
uncertainty, or adaptive controller. Both controllers are built on general sys- 
tem dynamic equations that are common for both distributed and lumped 
parameter models. Also, in order to maintain controller generality, neither 
nonlinear terms are neglected nor linearization is used to simplify the con- 
troller design. In the regular controller, we test the controller robustness by 
introducing uncertainty in payload description during the case studies. By 
choosing stable feedback gains and proper P matrix, the regular controller 
maintains system stability even under incorrect payload information and ini- 
tial position errors. However, as payload uncertainty increases and becomes 
a dominant factor, the regular controller performance degrades. To remedy 
this problem, an adaptive controller is introduced to undertake payload un- 
certainty. By using the fact that system dynamics are a linear function of 
inertial parameters, the uncertain payload is estimated on-line with the as- 
sistance of the least square estimation method. One requirement of ensuring 
estimate convergence is the persistently exciting condition which, as we point 
out through case studies, is correlated with the system physical motion. That 
is, if an uncertain parameter is not activated appropriately during a controlled 
motion, the estimator can not collect enough information to reconstruct the 
true identity. This observation indicates that for off-line system parameter 
calibration, laboratory engineers need to test the trajectory carefully in order 
to excite all parameters which are to be calibrated. 

One problem discussed in this report is the effect of update delay on 
the performance of adaptive controller. In real-time implementation, compu- 
tation delays create a disturbance to the adaptive controller which is built 
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on continuously updated signals. Therefore, the effect of update delay on 
controlled system stability is analyzed, and suggestions are given to eliminate 
update delay disturbance on controlled system response. Another important 
issue, a comparison between adaptive and nonadaptive control methodologies, 
is also demonstrated through example simulations. Of course, a case study 
can not represent a general comparison between adaptive and nonadaptive 
controller performances, especially for a nonlinear system where controller 
parameters such as the PID feedback gains and the P matrix are coupled 
with system parameters in the final controlled system response. Hence, ex- 
periments need to be conducted to demonstrate controller capability under 
different tasks and uncertainties. We list several criteria to compare experi- 
mental results, which will help the user to choose the best controller suited 
for a given task. 

Another way of solving the update delay problem is to design the 
controller based on a discrete time dynamic model and then to synchronize 
both computation and control update rates. However, it is difficult to convert 
nonlinear robotic dynamics from continuous time to discrete time description. 
Although, Euler’s method is often used to approximate the conversion, it is 
limited to slow varying systems. Hence, one solution is to write system dy- 
namics in terms of an autoregressive and moving average (ARM A) model 
with uncertain coefficients. Then self-timing regulator (STR) could be ap- 
plied to stabilize the uncertain system either by pole placement technique 
or one-step ahead optimization. In STR, the uncertain ARMA model coeffi- 
cients are estimated on-line and used in constructing control command. The 
drawback of STR method is that ARMA model coefficients must vary com- 
paratively slower than the STR update rate, otherwise, STR can not produce 
accurate estimates to generate the desired control command. Also, STR es- 
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timates ARMA model coefficients at every update step, so unless a simple 
relation such as linear proportion exists between payload uncertainty and es- 
timated coefficients, it is difficult to extract payload identity from estimated 
coefficients, which means that for nonlinear systems, STR could accomplish 
adaptive control assignment but might not be able to provide exact uncer- 
tainty information. 

In both regular and adaptive control approaches, we encounter one 
problem that the Lyapunov stability is not ensured when all nominal error 
states become zero but vibratory error state remains active. This unique 
character of compliant manipulators is due to dimensional mismatch between 
the number of available actuators and that of modeled degrees of freedom. 
Since passive vibratory modes are added to compliant system dynamics, their 
elimination relies on the regulation of nominal motion, which means that 
controller has to transmit damping action through nominal joints, so nomi- 
nal joints have the responsibility of eliminating structural vibration instead of 
just trajectory tracking. In the controller design, it is possible to disturb nom- 
inal tracking precision deliberately in order to obtain the Lyapunov stability. 
However, that is not an effective tradeoff, therefore, in both controllers, we 
propose methodologies to reduce the size of the spherical ball in error space 
where the Lyapunov stability is uncertain. In doing so, residual oscillation 
is left to be dampened passively by structural damping. In case residual os- 
cillation scale becomes intolerable, then a second phase controller could be 
employed to reduce residual oscillations. Now, the regular or adaptive con- 
troller designed before acts as the first phase controller that concentrates on 
trajectory tracking and vibration elimination. Once the nominal joints get 
closer to the terminal point and the error states approach the spherical ball 
that the Lyapunov stability is uncertain, then the second phase is switched 
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on. The second phase controller could be built on different control criteria, 
for example, one such second phase controller could be the optimal controller 
presented below. 


From our earlier case study experience, it is observed that in the 
vicinity of terminal steady state, the velocity states remain relatively small. 
Therefore, it is assumed that all coupling terms are negligible and gravity 
effect is compensated at terminal state, then, in the vicinity of the terminal 
point, the flexibility dynamics in Equation 4.9 could be approximated by the 
following linear time-invariant form 
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where A is a 2 (n s -f np) x 2 (n s + Tip) matrix, B is a 2 (n 6 + np) x ng matrix, T 
is an nj x n$ identity matrix, and X" is an rip x np identity matrix. Now, the 
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goal is to control q to reach q r at t — tj and minimize a cost function given 
by 

J = C {(? - qr) T S(q - q r ) + u T Wu}dt (7.4) 

where f 0 is the time optimal control starts, and S and W are two positive 
definite, diagonal matrices with S — S T € 7 £ 2 ( n e+ n 0 ) x2 ("e+ n 0 ) and W = W T £ 
77 neXne . According to [Bryson and Ho, 1975], Equation 7.4 is an optimal 
control problem with fixed terminal time and specified state variables, and 
one optimal solution is given by 

u = W~ l {B T A + B t $ t v) (7.5) 

where A is the Lagrange multiplier defined by 

A = —A T A — 2 Sq — 2 Sq r 

A(t 0 ) = 0 ; A <E ft 2 < n « +n /d (7.6) 

Because q is not specified at t = t 0 , A(f 0 ) = 0 is chosen in the above equation. 
Also, the $ in Equation 7.5 is given by 
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which is the transition matrix used in formulating the solution of q given by 
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where W c t is called controllability grammian and is nonsingular for a control- 
lable system in Equation 7.3. Since Equations 7.5 and 7.9 need to be solved 
iteratively, an off-line evaluated u value could be used in computing on-line 
the u given by Equation 7.5. Actually, t f could be free in order to obtain 
a minimum settling time control, yet, that will introduce another control 
parameter needed to be decided iteratively. Therefore, fixed time optimal 
control is chosen here. 

Additionally, in this report we introduce a special characteristic of 
compliant manipulators that has seldom been noticed. This is the inaccessi- 
bility problem of vibratory modes. According to the analysis in Chapter 4, 
manipulator configuration affects actively damping of structural oscillations. 
It is suggested that the inaccessible positions of a compliant manipulator 
should be identified before trajectory planning so that undesired working 
positions can be avoided. Also, since the first mode dominates structural de- 
flections, lumped parameter model will be an efficient and effective approach 
to study the inaccessibility problem. 

Due to the complexity of compliant manipulators, this report only 
investigates some of the dynamic and control problems. There are some issues 
of compliant manipulators that need further study, which are listed below: 

• development of lightweight robot designs for industrial applications 

• comparison between lumped and distributed parameter models 

• kinematic interpretation of vibratory mode inaccessibility 

• interconnection between the inaccessibility of the first mode and that 
of higher order modes 
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• compensation of robot structural deflections by adjusting joint motions 

• experimental verification of regular and adaptive control algorithms 

• improvement of regular and adaptive controller performance by intro- 
ducing the second phase controller 

• criteria for the selection of regular and adaptive controllers 

• implementation of micromanipulators to perform on-line compensation 
of structural deflection 

• incorporation of adaptive control with learning control to build an ac- 
curate system model for systems containing uncertain parameters 

These research topics require considerable effort, but they will certainly make 
lightweight manipulators become much more precise and efficient machines. 
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